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•ft******************* 
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disseminated, transferred or used without the prior 
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Copyright Eaton Corporation, 1993-94. 
All rights reserved. 



* Filename: <*tj*d&2ft (AutoSplit) 
« 

* Description: 

* The functions in this file will perform the required operations 

* for controlling drivel ine components on the J1939 communication link. 
* 

* Part Mumber: <none> 
* 

* $Log: R:\ashift\vcs\drl_cmds.c9v $ 

* — 

* Rev 1.9 25 Feb 1994 16:07:40 schroeder 

* Removed predip's (experimental) SIM 8 ramp off rate—no longer needed. 

* Added condition to predip's torque bumps: timers are frozen until 

* actual enginejxt trq responds. Important when engine brakes are on. 

* Made R E COVE RY_STEP_T ABLE [3 a constant value—all ratios used 8%. 

* ~* ~" 

* Rev 1.8 21 Feb 1994 15:07:26 schroeder 

* Replaced shiftabilityjnode with new flag, engineer a ke_avai table. 

* ~ 

* Rev 1.7 03 Feb 1994 15:57:28 schroeder 

* Added setting of command_ETC1 to each command function, enabling 

* overspeed during control~engine_predip() and control_engine_sync() and 

* disabling overspeed during all others. 
* 

* Rev 1.6 17 Nov 1993 09:50:10 amsallen 

* In the initiate function, net_enginejxt_trq was replaced with 

* act engine_pct_trq since desi red_engine jxt_trq values are in indicated 

* power not net_power. Also the sync_timer timeout was reduced to 100 for 

* down shifts and 200 for upshif tsd'second and 2 seconds) rather than 200 

* for all shifts. Also the delay at 0 torque after a time out was increase 

* from 150msec to 250 mesec. 

* Rev 1.5 04 Nov 1993 09:16:08 schroeder 

* In RECOVERY_STEP_TABLE 13 , restored the value for sixth gear to 8%, 

* ~ "~ 

* Rev 1.4 02 Nov 1993 09:40:06 schroeder 

* Replaced demand_eng i ne_pc t_t rq with pct_demand_at_cur_sp. Engine 

* speed limit during torque limit operation changed from high idle to 

* 8031 rpm, as suggested in J1939/71. 
* 

* Rev 1.3 11 Oct 1993 14:22:40 schroeder 

* Removed cruise_contro Inactive flag; replaced accel pedal with 

* demanding ine_pct_trq. 

* Rev 1.2 22 Sep 1993 10:48:22 amsallen 

* The function control engine sync was changed to resolve OR 3235ma08.deb, 

* clunky low throttle high range shifts* The engine target now moves above 

* sync when input_speed - sync < 40 rp« and transmission position » engaging 

* rather than just tp * engaging* S«*> 0* 3235ma08.deb for additional details. 
* 

* Rev 1.1 01 Sep 1993 14:09:52 schroeder 

* In control_engine_sync, modified dither to insure that the engine 

* target stays below sync for a range shift. Also, the dither amount 

* increases from 35 rpm to 100rpm, then repeats. 
* 

* Rev 1.0 29 Jul 1993 16:40:40 schroeder 

* Initial revision. 
* 



/************************************************************************ 
* 

* Header files included. 
* 



# include <exec.h> 



/* executive information V 



finclude <c re*s.h> /* Kt internal r eg i iter definitions */ 

^include <wi*lib.h> /* contains common global dsfint* V 

tMncludt n cont sys.h* /* control system information V 

#include u conj1919.h ls /* defines interface to j 1939 control module V 

#include a drl_cso*.h» /* drive line commands information */ 

^include "trn'tbl *h" /* transmission table data structures */ 

^include "sel^gear.h* /* access to speed filter values */ 
#include "calc_spd.h«» 
#include "trns act.h" 



#pragma noreentrant 
,****************************** 

* ^defines local to this file. 



#define USJ>ER_LOOP 10000U 

#define ACT I VE_RECOVERY_GEAR 10 /* rule out boosting downs for now V 
* 

* Constants and variables declared by this file. 
/* public */ 

register uchar engine_commands; 
register uchar engine_status; 
uchar des i red_sync_test_mode; 
/* uint desired_eng_spd_new; */ 
/* uint desi red_eng_spd_del ta; */ 
/* uint des i r ed~eng~s pd~d iff; */ 
u i nt des i r ed_eng i ne_speed_t es t ; 
ui nt des i red~eng i ne~speed_ramp; 
uchar desired_engine_speed_timer; 
uchar desi red~engine_speed_t ime; 
uchar eng_brake_command; 
uchar eng_brake_assist; 
uchar posi t ive^p^dal^rans; 
uchar sync_f i rst_pass_timer; 
uchar clutch_state; 
uint clutch~slip_speed; 
int dos_f i I tered; 
int overal l_error; 
unsigned int o s_ba s ed_on_ res; 
unsigned int input_speed_f i Itered; 
unsigned long is_f Utered_bin8; 
unsigned int output_speed_f i I tered; 
unsigned long os_f i ltered_bin8; 
signed int input_speed_accel_f i Itered; 
signed long dis_f i I tered J>i ri- 
cher engj>ercent_torque_f i I tered; 
char percent_torque_accessories; 
char needed J» r cen t ~f or_zero_f I ywheel_trq; 
uchar zero^Hywheel^trcfcJimerJ 
uchar zero"f lywheet^tro^ltmt; 
uchar accelerator _pedal_pos1tion_old; 
int input shaft accel calculated; 

uint gos; ~ /* overall destination gear ratio * output speed BIN 0 */ 

int gos_signed; /* overall destination gear ratio * output speed BIN 0 V 

uint gos_current_gear; /* overall current gear ratio * output speed BIN 0 */ 



unsigned char sync_f irstjwss; 

unsigned int sync"maintain_timer; 

signed int sync_offset; 

signed int syncjdos_of fset; 

signed int sync_dos_offsetJC1; 

signed int sync_speed_modif ied; 

unsigned char intent_to_shif t; 

char intent'f inal_pct_trq; 

char intent_ramp_off_rate; 



/* local */ 



static uint prtdip_tia»rj; 
static uchar pradip_tl«tr_2? 
static uchar pradl p~t iswr_3; 
static char pred1p.torqua M bunp w va(ua; 
static uchar pradi p_torqua_bL«p_t J a»; 

static uint sync_on_tiwr; 
static uint sync*off_ti mr; 
static uchar synced ithar^ti mar; 

static uint torqu*_ limit; 
static uchar recovery_cancal_timer; 
static uint recov_coast_down_tmp1 ; 
static uint recov_coast_down_tmp2; 

static int dgos; 

static int I pfjxi tput_acce I; 



#pragma EJECT 



* 



PR ED IP MQOE CONSTANTS 



7 



JrOCT 1 nC 


rKCU 1 r 


7con rnair time 




/ 




#def ine 


PREOIP* 


"TORQUE ZERO.TIME 


60 


/* 


0.60s 310ms period 


#def ine 


PREOIP" 


"normal'time" 


200 


/* 


2.00s 310ms period 


#def ine 


torque] 


]ramp_off_rate 


1 


/* 


1% (per loop) V 


#def ine 


PREOIP 


TORQ BUMP VALUE LO 


0 


/* 


OX */ 


#def ine 


PREOIP" 


JORQ~BUMP~TIMEJTo 


15 


/* 


0.15s 310ms period 


#define 


PREOIP 


TORQ BUMP_VALUE_MED 


5 


/* 


5% */ 


#def ine 


PREDIP* 


J0RQ~BUMP~T I MEJ4ED 


25 


/* 


0.25s 310ms period 


#def ine 


PREDIP 


TORQ BUMP VALUE HI 


10 


/* 


10X */ 


#def ine 


PREOIP^ 


>ORQ~BUMP~TIMEjIl 


30 


/* 


0.30s 310ms period 



/♦★★A******************************************************************** 
* 

* SYNC MOOE CONSTANTS 



************************************************************************/ 



#def ine 


SYNC DITHER TIME_ABOVE 


20 


/* 


0.20s 310ms period 


V 


#define 


SYNC~DITHER~TIME BELOW 


30 


/* 


0.30s 310ms period 


*/ 


#def ine 


SYNC~DITHER~RPM " 


35 


/* 


35 rpm 


V 


#def ine 


syncjmtherjmrstjtime 


255 


/* 


DUMMY VALUE 


*/ 


#define 


MAINTAIN SYNC TIME 


500 


/* 


5.00 Sec 


*/ 


#define 


SYNC FIRST PASS_TIME 


250 


/* 


2.50 Sec 


*/ 


#def i ne 


THREE PERCENT 


3 








#def ine 


ENG RESPONSE UPSHF_TIME 


10 


/* 


10 msec 


*/ 


#def ine 


ENG~RESPQNSE~DNSHF TIME 


10 


/* 


10 msec 


V 


#define 


SYNC DOS OFFSET CONSTANT 


2816 


/* 


11 BIN 8 


V 



* 

* RECOVERY MOOE CONSTANTS 

* 



#define RECOVERY CANCEL TIME 10 /* 0.1 0s 310ms period V 

^define RECOVERY~CANCEL~OFFSET 20 /* 20X BIN 0 */ 

#define RECOVERY~TORQUE~STEP 1280 /* 5X BIN 8 */ 
#define THL0 OS ENG DECAY K1 450 

^define THLO~DS~ENG"dECAY"rAMP 1 /* 1 rpra BIN 0 */ 

#define THL0_DS~FInTshEDJ)ELTA 200 /* 200 rpm BIN 0 */ 

static const uint RECOVERY RATE TABLE [23] = 
i 

0, /* -4 */ 

0, /* -3 */ 

128, /* -2 

128, /* -1 



7 

0.50X per loop BIN 8 */ 

0.50X per loop BIN 8 V 

128, /* 0 : 0.50% per loop BIN 8 V 

128, /* 1 : 0.50X per loop BIN 8 */ 

128, /* 2 : 0.50X per loop BIN 8 V 

128, /* 3 : 0.50X per loop BIN 8 V 

128, /* 4 : 0.50X per loop BIN 8 */ 

192, /* 5 : 0.75X per loop 8IN 8 V 

192, /* 6 : 0.75X per loop BIN 8 V 

192, /* 7 : 0.75X per loop BIN 8 V 

281, /* 8 : 1.10X per loop BIN 8 V 

281, /* 9 : 1.10X per loop BIN 8 V 

281, /* 10 : 1.1 OX per loop BIN 8 V 
0, /* 11 V 



0, /* 12 

0, /* 13 

0, /* 14 

0, /* 15 

0, /* 16 

0, /* 17 

0 /* 18 • 

>; 



ft * * * ****************** 

* Function: initialize_drivel ina_data 

* "~ ~ 

* Description: 

* This function, called after all resets, will initialize the system 

* copy of drivel ine related data received from the coomuni cat ions link. 
* 



static void initialize drivel ine data(void) 
< 

acceleratorjjedaljposition » 0; 
engine jroninuni cat ion_active « FALSE; 
engine~brake_avai table * FALSE; 

eng brake jrommand » ENG BRAKE IDLE; /* should init with engine_commands 

clutch_state * ENGAGED;" 

positive_pedal_trans * FALSE; 

zero_f lywheel_trq_timer » 0; 

zero_f lywheel_trq_time = 0; 

percent_torque_accessories = 3; 



/* 
/* 



debug use only 
debug use only 
debug use only 



desired_sync_testjnode * FALSE 

desired_engine_speed_test a 0 

desired_engine_speed_ramp 3 0 

des ired_engine_s peed » 0; 
/* des i r ed_eng_spd_new =0; */ 
/* desired_eng_spd_diff * 0; */ 
/* des i red_eng_spd_de 1 1 a = 10; */ 

desired engine speed timer = 0; 

syrx:_dos_offsetja *~SYNCJ)OS_OFFSETj:ONSTANT; 

des i red_eng i ne_speed_t i me = 0; 

intent_to_shift = FALSE; 

intent_f inal_pct_trq = 0; 

intent~ramp_of f_rate = 1; 



delete 
delete 
delete 



later 
later 

later 



V 
V 
*/ 



#pragma EJECT 



* Function: control_tngirw_predip 

* Description: 

* Determines throttle command for predip mode. 
• 

* After a reasonable delay for the transmission to pull to neutral the 

* torque will be cycled from zero to a determined value to help the 

* transmission achieve neutral. 
* 

*****#******************************************************************/ 

static void control engine_predip(void) 
< 

if (engine status !* ENGINEERED I PJWOE) 

engine_status = ENG I NE_PRED I P_MOOE ; 

predip_timer_l = 0; 
predip~t imer~2 = 0; 
predip_timer_3 = 0; 

if (actual engine jxt.trq < 5) 

predipjtimerj = PRED I P_NORMAL JIME; 
else 

desired engine _pct_trq = actual_engine_pct_trq; 

> 

engine control = TORQUE CONTROL; 
commandJTCI = C_ETC1_OVERSPEED; 

if (predip timer 1 < PRED I P_N0RMAL_T I ME ) 
< 

if ((desired_engine_pct_trq >= TORQUE_RAMP_OF F_RATE ) && 
(actual enginejxt trq > 0)) 

( 

desired enginejxt trq -= TOROUE_RAMP_OF F_RATE ; 

> 

else 

i 

desired_engine_pct_trq = 0; 

/* check to force bump if neutral not achieved */ 

if (actual enginejxrt trq < 10) 

C 

if (++predip timer 3 >» PRED I P_ZERO_FDBK_T I ME ) 
predip timer 1 = PREDIP NORMAL TIME; 

> 

> 

++pr edip timer 1; 

> 

else 
{ 

if ((Ipf output accel > -150) U 

(predip timer 1 < (PREDIP NORMAL TIME ♦ PREDIP_TQRQUE_ZERO_TIME))) 

( 

predip torque bump tint * Pft£D!PTO*Q_BUMP TIMEJ.O; 

predfp~torque~bujtp~value » Pft£DlP_TO*0_BUMP - VALUEJ.O + needed_percent_for_zero_f lywheel.trq; 

> 

else 
{ 

if (predip timer 1 < (PREDIP NORMAL TIME ♦ 2*PREDIP_TORQUE_ZERO_TIME)) 
predip torque bump time » PREDIP_T0RG_BUMPJIMEJ1ED; 

predip"torque~bump"value » PREDIP_TQRQ BUMP VALUE_MED ♦ needed _percent_for_zero_f lywheel_trq; 

) 

else 
< 

predip torque bump time « PREDIP.TORQ BUMP TIMEJU; 

predip"torque"bump"value » PREDIP_TORQ BUMP_VALUE_H I ♦ needed _percent_for_zero_f I ywheel_trq; 

> 

> 

if (predip timer 2 < predip torque_bump_time) 
< 

desired_enginejxt_trq = predip_torque_bump_velue; 

if (actual engine _pct trq > 0) 

i 



♦*pr«d1p_ti«§0; 

> 

> 
( 

desired.engine^pct.trq * 0; 
♦*pred i p_t i nec_1 ; 
♦♦predip tiwr 2r 

> 

if (predip_titntr_2 >• PREDlP_T0ROU£_ZERO,TIME) 
predip timer 2 ■ 0; 

> 

> 

#pragma EJECT 



*** ************* #***»****** ************************************* ** 

* Function: control _eng i ne_sync_ I ever (AutoSplit) 

* "~ 

* Description: 

* This function synchronizes engine speed to output shaft speed 

* during a shift. 
* 



static void control engine sync_lever(void) 

i 

if (acceler at or_peda Imposition > THREE_PERCENT) 
syncjnaintain_timer * MA I NT A I N_SYNC_T 1 ME ; 

if ((engine status !» ENGINE SYNC MOOE) || (sync maintain timer « 0)) 
< 

sync_on_timer = 0; 
sync_of f_t imer = 0; 

if (engine status 1= ENGINE SYNC MOOE) /* first time through sync */ 
i 

sync maintain timer = MAINTAINING TIME; 
engine status"* ENGINE SYNC MOOE; 

> 

else /* sync maintain_timer reached 0 */ 

i 

engine control = OVERRIDE DISABLED; 
command ETC1 ' C ETC1 NORMAL; 

> 

> 

else 
C 

syncjna intain_timer--; 

if (sync on timer++ <= 296) /* allow sync mode for about 3 SEC */ 
C 

sync_of f_t imer = 0; 

engine control = SPEED CONTROL; 

command_ETC1 * C_ETC1 JDVERSPEED; 

if (shift type == UPSHIFT) 

sync offset = -65; /* RPM V 

> 

else /* shift is a downshift */ 

sync offset » -65; /* RPM */ 

> 

if (gos signed ♦ sync offset > 0) 
{ 

/* desired_engine_speed ■ (int)(0os_signed ♦ sync_offset); V 

cx = doe filtered; /* BIN 0 */ 

~bx » trn'tbl.geer rati ©[destination gear ♦ GR OFS]; /* BIN 8 */ 
"ax a sync doe offset K1; ~ " /* BIN 8 */ 

asm mul _cxdx,~_bx; " /* BIN 8 V 

asm div ~cxdx # "ax; /* divide by constant BIN 8 */ 

sync_dos_of fset • _cx; /* save final result BIN 0 */ 

desi red_engine_speed » ( int)(gos_signed ♦ sync_offset ♦ sync_dos_of f set ) 

*if (0) 

desired_eng_spd_new » (int)(gos_signed + sync_of f set); 

if ( des i red_eng_spd_new > des i red_eng i ne_speed ) 

des i red_eng_spd_dlf f « des i red_eng_spd~ne« - des i red_eng i ne_speed; 
else " 

des i red_eng_spd_di f f * des i red_eng i ne_speed - des i red_eng_spd_new; 

if (desired_eng_spd_diff > des i red_eng_spd_de 1 1 a ) 
desired engine speed » desired eng spd new; 

#endif 



els* 

desired engine speed ■ 0; 

> 

else 
{ 

if (sync off timer <» 4) 
( 

sync off timer*-*; 

#if (0) 

engine control » TORQUE CONTROL; 
conmandJTCI » C_ETC1_0VERSPEED; 

desired~engine _pct trq * neededjjercent for zero f lywheel_trq; 

#endif 

> 

else 

sync_on_timer 3 0; 

> 

> 

> 

^pragma EJECT 



* 

* Function: control_engine_sync_auto (AutoSplft) 

* — — — 

* Description: 

* This function synchronizes engine speed to output shaft speed 

* during a shift. 
* 

static void control engine sync auto(void) 

if (acceterator_pedal_posi tion > TH*EE_PERCENT) 
sync_maintain_timer 3 MAINTAIN_SYNC_TIME; 

if ((engine status I* ENGINE SYNC MOOE) || (sync maintain_tiraer ■« 0)) 
( 

sync_on_timer » 0; 
syncj>f?_ timer = 0; 
sync'f irst_pass = TRUE; 

sync~first_pass_timer » SYNC_FIRSTJ>ASS_TIME; 

if (shift_type « UPSHIFT) 

sync_offset = -65; 
else 

sync_offset = 65; 

if (engine status 1= ENGINE SYNC MOOE) /* first time through sync */ 

sync maintain timer = HA I NTA I N_SYNC_T I ME ; 
engine status~= ENGINE SYNC MOOE; 

> 

else /* sync maintain timer reached 0 V 

t 

engine control * OVERRIDEJMSABLED; 
command ETC1 » C ETC1 NORMAL; 

> 



else 
C 

sync_ma i nta i n_t i mer- - ; 

if (sync on timer** <= 200) /* allow sync mode for about 2 seconds V 

sync_of f_timer = 0; 

engine control = SPEED CONTROL; 

command_ETC1 » C_ETC1_OVERSPEED; 

if (sync first_pass == TRUE) 
{ 

if (shift type « UPSHIFT) 
( 

sync speed modified = (signed int)( input speed) ♦ 

(input_speed_accel~filtered /(1Q00/ENG_RESPQNSE_UPSHFJIME)) 

if (sync speed modified < gos signed) 
< 

if (sync first_pass timer » 0) 
C 

sync offset ■ 65; 
syncjf retype** ■ FALSE; 

> 

else 

sync first _pass timer--; 

> 

> 

else /* shift is a downshift */ 
{ 

sync speed modified 3 (signed int)( input speed) ♦ 

(input_speed_accel~filtered /(1 000/ ENGJIE SPOUSE J)NSHF_TIME)) 

if (sync speed modified > gos signed) 
( 

/* if (sync first_pass timer ■» 0) */ 
/* < " V 

sync_f f rst_pasa « FALSE; 

if (pctjje«wid_at_cur_sp < 15) 
sync^offset « -65; 



/* 

/* 

> 



> 

•Itt 



*/ 

V 



> 



) 



if (gos_signed ♦ sync_offset > 0) 

desired_engine_sp€«d ■ (int)<gos_signed ♦ sync_of fset); 
else 

desired_engine_speed * 0; 



if (sync off timer <= 4) 
< 

sync off timer**; 

#if <0) 

engine control * TORQUE CONTROL; 
command_ETC1 * C_ETC1_OVERSPEED; 

desired%ngine _pct_trq * needed_percent_for_zero_f lywheel_trq; 



sync_on_timer ■ 0; 

sync~offset * -(sync_of fset); /* force sync speed to toggle around gos 



> 

> 

> 

tfpragma EJECT 



) 

else 



#endif 



> 

else 



* 

* Function: control _engine_sync (AutoSplit) 
* 

* Description: 

* This function synchronizes engine speed to output shaft speed 

* during a shift. 
* 

static void control engine sync(void) 
C 

if (shift_init_tvpe — AUTO) 
control~engine_sync_auto( ); 
else 

c on t r o I _eng i ne_sync_ I ever < ) ; 
intent_to_shift = FALSE; 

> 

tfpragma EJECT 



* Function: control _eng f ne_s ync_ t e* t joode (AutoSplit) 

* . ™ " ■ 

* Description! 

* This function test the synchronizt mode of engine speed control. 



static void control engine sync test mode(void) 
i 

if (accelerator_pedal_posi tion < 10) 
( 

engine_status = ENGINE_FOLLOUER_HOOE; 
engine~commands - E NG I ME_ FOLLOWER ; 
engine~control * OVERRIDE DISABLED; 
ccmnandJTCI * C_ETC1_NO«KAL; 
desired~engine speed * 0; 

) 

else 
i 

if (accelerator_pedaljposition > 90) 
i 

engine_status * ENGINE_SYNC_MO0E; 

engine^conmands = ENGIHE_SYNC; 

engine~control « SPEED_C0NTR0L; 

cc<nmand_ETC1 * C_E TC1JDVER SPEED ; 

des i red~eng i ne_speed = des i red_eng i ne_speed_t est ; 

desired engine~speed timer = desired_engine_speed_time; 

> 

else 
i 

if ( des ired_engine_speed_ timer > 0) 

des i r ed_eng i ne_speed_t i me r - - ; 
else 

i 

if (desired engine speed > 600) 
< 

desired_engine_speed_timer * desired_engine_speed_time; 

desi red"engine~speed~* (desired engine speed - desired_engine_speed_ramp); 

> 

> 

> 

> 

> 

#pragma EJECT 



* Function; determine^ f_recoveryj:omplete 

* ™ 

* Description: 

* This routine checlcs to see if the percent_torque_value_limit has 

* exceeded the percent _torque_va I ue feedback from the engine by xX 

* for x milliseconds and will then set percent_torque_value_l irai t 

* to 100% to cancel the recovery mode. 
* 

static void determine if recovery complete(void) 
i 

if ((net engine_pct trq > 10) && 

(desired engine_pct trq > (net enginejxt trq + RECOVERY CANCEL OFFSET))) 

< 

♦♦recovery cancel timer; 

> 

else 

recovery_cancel_timer = 0; 

if ( (recovery_cancel_tiraer >* RECOVERY_CANCEL_T IME ) || 
(desired enginejxt trq " 100) ) 

< 

/* terminate the recovery mode */ 

desired enginejxt trq = 100; 

engine status * ENGINE RECOVERY MODE COMPLETE; 

> 

> 



#pragma EJECT 



* 

* Function: control_enginej"ecovery_normal 
* 

* Description: 

* Oet ermine throttle contend for recovery mode. 

* TOftQU€_LIMT it scaled as a BIN 8 number representing the percentage 

* of torque allowed to the engine during recovery. 
* 

static void control engine recovery_nonnal(void) 

i 

engine control = SPEED TORQUE J.IMIT; 
command_ETC1 3 C_ETC1_NORMAL; 

desired_engine_speed * 8031; /* torque limit only, max value for speed */ 
torquejimit ♦» RECOVERY_RATE_TABlE tdestinat ion_gear+43 ; /* BIN 8 */ 
desired_enginejpct.trq * <char)(torque_limit » 8); /* BIN 0 */ 
determine if recovery_complete<); 

> 



^pragma EJECT 



* Function: control_tnQine_recovery_coasting 

* " — 

* Description: 

* Determine throttle command for coasting down shifts mode. 
* 

*************************** *********************************************/ 

static void control engintj'ecovery coesting(void) 

register uint local_uint; 

if (sync on timer <= 300) 
t 

sync_on_ timer ; 

engine_control = SPEED CONTROL; 
commandJTCI » C_ETC1_NORMAL; 

sync_off_tiroer « 0; 

/** recov_coast_down_tmp1 = gos ♦ (dgos * K1) - THLO_DS_ENGJ)ECAY_RAMP **/ 

if (dgos < 0) /* get absolute value V 

_cx = (uint)-dgos; 
else 

_cx » (uint)dgos; 

asm mulu cxdx, #THL0 DS ENG DECAY K1; /* BIN 12 */ 

asm shrl jrxdx, #12; " /* BIN 0 */ 

if <_cxdx > 500) /* error check */ 

local_uint * 0; 
else 

local_uint = _cx; 

if (Ipf output accel > 0) 

recov_coast~down_tmp1 ■ (gos ♦ local_uint) - THL0J)SJNGJ)ECAY_RAMP; 
else " ~ - - - - 

recov_coast_down_tmp1 * (gos - local_uint) - THL0_DS_ENG_DECAY_RAMP; 
/** recov_coast_down_tmp2 * desired_engine_speed - THL0J)S_ENGJ>ECAYJ*AMP 1 
recov_coast_down_tmp2 ■ desired_engine_speed - THL0J>S_ENGJ)ECAY_RAMP; 

if (recov - coast_down - tmp1 < recov_coast_down_tmp2) 

des i red_eng i ne_speed * recov_coast_down_tmp1; 
else ~ " 

desired engine speed = recov coast down tmp2; 

> 

else 
C 

if (sync off timer <■ 5) 
C 

++sync off timer; 
engine~control * TORQUE CONTROL; 
coonandJTCI » CJTC1JORWU; 
desired engine _pct trq ■ 0; 

> 

else 

8ync_on_timer » 0; 



if ((desired engine speed ♦ THL0 OS FINISHED DELTA) < gos) 
{ 

/* terminate the recovery mode V 

desired engine _pct trq * 100; 

engine status » ENGINE RECOVERY MODE COMPLETE; 

> 

> 



#pragma EJECT 



* Function: control_engine_recovery 

* "~ ~ 

* Description: 

* This function determines which type of throttle recovery should be 

* used. And initializes some of the variables that will be used. 



static void control engine recovery(void) 
C 

if ((engine status !=> ENGINE RECOVERY MOOE) && 

(engine status !* ENGINE RECOVERY MOOE COMPLETE)) 

( 

engine_status * E N G I NE_RE COVE R Y_MODE ; 
desired_engine jxt_trq = 0; 
recovery_cancel_timer * 0; 
sync_on_timer = 0; 
syncjDf f_t imer = 0; 

/* kill pedal transition stuff */ 
positive_pedal_trans * FALSE; 
positive _pedal"trans » FALSE; 
zero_f lywheel_trq_timer = 0; 
zero~f lywheel~trq_time = 0; 

if (gos < desired_engine_speed) 
des i red_eng i ne~speed = gos; 

/* set initial starting torque limit */ /* percent, BIN 8 V 
if ((actual_engine_pct_trq > needed_percent_for_zero_f lywheel_trq) && 
(pct_demand_at_cur~sp > 5)) 
torque~limit = ((unsigned int)(actual_enginejxt_trq))«8; /* percent, BIN 8 */ 
else 

torque limit = ((unsigned int)(needed_percent for zero flywheel trq))«8; /* percent, BIN 8 V 

) 

if ((destination_gear > ACTIVE_RECOVERY_GEAR) && 
(pet demand at cur sp < 5) && 
((Shift type == COAST DOWN SHIFT) || 
(shift type « UPSHIFT))) ~ 

( 

control engine recovery coast ing(); 

> 

else 
C 

control engine recovery normalO; 

> 

#pragma EJECT 



* Function: control J ntent_to_shi ft 
* 

* Description; 

* This function 

static void controMntent_to_shif t(void) 



if (engine control I* TORQUE CONTROL) 
{ 

desired enginejxt trq = actual engine _pct trq; 

) 

engine control = TOROUE CONTROL; 
conroand_ETC1 * C_ETC1_0VERSPEED; 

positive j>ed8l_trans = TRUE; /* allow for recovery mode */ 

if (<desired_enginejxt_trq >= intent_ramp_of fj-ate) && 

(actual enginejxt trq > intent final _pct trq)) 

i 

desired enginejxt trq -* intent ramp off rate; 

> 

else 
C 

desired engine_pct trq = intent final_pct trq; 

> 



#pragma EJECT 



y********************************************* ******** ******************* 

* Function: control_engine_fol lower 

* Description: 

* This function sets the override_control jnode to no over ride so that 

* the engine follows the accelerator demand. 

**********************************★******#******************************/ 

static void control engine foltower(void) 
( 

#define POSITIVE PEDAL TRANSITION TIME 25 /* 250 MSEC V 
#define NEGATIVE"PEDAL~TRANSITION_TIME 40 /* 400 MSEC */ 



engine_status = ENG I NE_F0L LOWER_MGOE ; 

if ((intent_to_shift == TRUE) && . 
(shiftJFn_process == FALSE) && \ 
(desired gear != destination gear selected)) * 

C 

control intent to shiftO; 

> 

else 
i 

if ((accelerator_pedal ^position >= 5) &4 /* positive pedal transition V 
(accelerator_pedal_posi tion_old <= 4) && 
(low speed latch == FALSE))" 

C 

pos i t i ve_peda I trans = TRUE; 

zero flywheel trq_time = POSITIVE PEDAL TRANSITION TIME; 
if (zero_f lywheel^trc^t imer >= NEGATIVEJ>EDAL JRANSITIONJIME) 
zero flywheel trq_timer = 0; 

> 

else 
i 

if ((accelerator_pedal_position <= 4) && /* negative pedal transition */ 
(acceterator_pedal_position old >= 5) && 
(low speed latch == FALSE))" 

< 

zeroJlywheel_trq_time = NEGAT I VE_PEDAL_TRANS I T I0N_T I ME ; 
zero flywheel trq_timer = 0; 
> " 

if ((zero_f lywheel_trq_timer < zero_f lywheel_trq_time) && 

(current gear > 1) && (current gear < 10T && (low speed latch « FALSE)) 

( 

engine control = TORQUE CONTROL; 
comma ndJTCI = C_ETC1_OVER SPEED; 

desired^engine _pct_trq » neededjpercent_for_zero_f lywheel_trq; 

if (actual^engine _pct_tro> < (needed _percent_for_zero_f lywheel_trq ♦ 5)); 
zero flywheel tr^tT«er++; 

) 

else 

i 

if ((positive_pedal trans » TRUE) U (low speed latch ■« FALSE)) 
i 

positive_pedal_trans » FALSE; 

engine_commands = ENGINE_RECOVERY; /* engine: finish torque return 

control engine recoveryO; 

) 

else 
C 

engine control = OVERRIDE DISABLED; 
command ETC1 = C ETC1 NORMAL ; 

> 

> 

> /* end no intent to shift V 

> 

fpragma EJECT 



* Function: control_engine_idle 

* " 

* Description: 

* This function sets the engine controls for the idle mode. 
* 



static void control engine idle(void) 
( 

engine control =• OVERRIDE DISABLED; 
command_£TC1 = C_ETC1_NQRMAL; 

engine status = ENGINE IDLE MOOE; 

> 



#pr agma EJECT 



* Function: com rot_«ng1ne_s tart 

* Description: 

* This function sets the engine controls for the start mode. 
* 

static void control engine.s tart (void) 
< 

engine control « OVERRIDEJMSABLED; 
canmandJTCI = C_ETC1 .NORMAL; 

engine status = ENGINE START MODE; 

> 



#pragma EJECT 



* Function: cont rol _tng i ne_conpress i on_br ike 

* "~ 

* Description: 

* This function controls the state of the engine compression brake. 

* The brake can be used o\jring upshifts to speed up the dec el rate of 

* the input shaft. 
• 

static void control engine compression brake(void) 
C 

if (engine communication active && 

(engine^status « ENgTmE SYNC MOOE) 44 
<shift_type =» UPSHIFT) U 
<input~speed_f iltered > (gos ♦ 150)) && 
(destination_gear > 1) &£ 
(destination_gear < 7) && 
( eng i ne_br ake_ava i I ab I e ) && 

((dos_predicted < dosjardtd lira no jake) || eng brake assist)) 

< 

eng brake assist * TRUE; 

) 

else 
( 

eng brake assist = FALSE; 

> 



engj)rake_assist s FALSE; /* force false state for now */ 



ffpragma EJECT 



y ********************** 
* 

* Function: detenu ne_gos 
• 

* Description: 

* This function mulitplies the destination gear ratio times the 

* output shaft speed for use in the DRL_CM0S module. 

* ~ 

* gos 3 <g)ear * (o)utput (s)peed 
* 

***************************************^^ 



static void determine gos(void) 



/*** determine gos for the destination_gear ***/ 
_bx » trn_tbl.gear_ratiotdestination_gear ♦ GR_0FS1; 
"cx » output speed"f ittered; /* output speed"*/ 
asm mulu cxdx, bx; /* BIN 8 result */ 

asm shrl "cxdx, #8; /* make BIN 0 */ 

gos » _cxj /* BIN 0 */ 

_cx = *<uint *)&lpf_output_accel; 
asm mul _cxdx, _bx; 
asm div "cxdx, #256; 
dgos = *<int *)&_cx; 

gos_signed = (signed intXgos); /* allow signed math in other functions*/ 

/*** determine gos for the "current_gear" ***/ 
_bx = trn_tbl .gear-ratio [cur rent^gear + GR_0FSJ; 
_cx » output_speed_f i Itered; /* output speed */ 
asm mulu cxdx, bx; /* BIN 8 result */ 

asm shrl "cxdx, MS; /* make BIN 0 */ 

gos_current_gear = _cx; /* BIN 0 */ 



^pragma EJECT 



Functi on: deterai ne.shf f tabi I 1 ty_var i able* 



Description: 

This function filters both the output speed and the rate of change of 
the output speed for use in the shiftability function. This function 
also calulates the rate of change of the input shaft based on the 
filtered value for the rate of change of the output shaft. 

The filters used in this function are required to get a high level of 
stability. The BIN 8 filter used here will provide a much smoother 
output which is needed to filter out drivel ine oscillations. 

Note: These calculations were placed in this module because it is 
called on a regular 10 msec interval. These calculations should 
be placed in the pr.i.s.i.c96 module once shiftability is proven. 
These variables a refused in the SEL GEAR.C96 module. 



****************** 



static void determine shiftability variables(void) 
C 



/* LPF coefficients 


: exp(-wT), 


T=0.010s 


V 




#def ine OS.LPF 


248 


/* 


0.9691 


BIN 8 (0.50Hz) 


V 


#define DOSFK1 


249 


/* 


0.9727 


BIN 8 (0.44Hz) 


V 


#define EPTFK1 


252 


/* 


0.9844 


BIN 8 (0.25Hz) 


*/ 


fctefine IS FK1 


236 


/* 


0.9219 


BIN 8 (0.??Hz) 


*/ 


tfdefine OS FK1 


236 


/* 


0.9219 


BIN 8 (0.??Hz) 


*/ 


#def ine DISFK1 


236 


/* 


0.9219 


BIN 8 (0.??Hz) 


V 


#define LOU RANGE 


3197 


/* 


3.1224 


BIN 10 


*/ 


#define SIN~10 


1024 











static long dos.f i ltered.bin8; 
static int ept_7i Itered.binS; 

unsigned long is.f i ltered_partial_1; 
unsigned long is_f i ltered_partial.2; 
unsigned long os~f i ltered_partial~1; 
unsigned long os.f i ltered.partial.2; 

/** create I pf .ou t put .acc el **/ 

_bx = *<uint *)&output speed accel; /* .bx « x<n), BIN 0 */ 

cx = *(uint *)&lpf output accel - bx; /* "cx * y(n-1) - x(n), BIN 0 */ 

asm mul cxdx, #OS LPF; ~ /* cxdx * K*(...), BIN 8 */ 

asm div "cxdx, #256; /* make BIN 0 */ 

.bx *» .cx; /* _bx » x(n) ♦ K*<...), BIN 0 

Tpf.output.accel = *(int *)&.bx; /* save acceleration */ 



/** dos.fi Itered = (dos.fi Itered * DOSFK1) ♦ (Ipf.output.accel * (1-DOSFK1) **/ 



_cxdx » *(ulong *)&dos_f i Itered.bfnS; 

asm shral .cxdx, #2; " " 

asm mul _cxdx, #DOSFK1; 

asm shral cxdx, #6; 

dos.fi ltered_bin8 » *(long *)&cxdx; 

cx » *(uint *)4lpf output accel; 
"bx » 256 - D0SFK1;~ 
asm mul _cxdx, .bx; 
dos.fi I tered.bin8 ♦» *(long *)&.cxdx; 



/* BIN 8 V 
/* BIN 6 < cx) */ 
/* BIN 14 V 
/* BIN 8 */ 
/* save partial result */ 

/* BIN 0 V 
/* 1 BIN 8 - D0SFK1 */ 
/* BIN 8 */ 

/* sum is final result V 



dos.fi Itered * (int)(dos_f i Itered.binS » 8); /* BIN 0 */ 

/** eng.percent torque filtered » (engjjercent.torque filtered * EPTFK1) ♦ 
(net~engine_pct.trq * (1-EPTFK1) **7 



cx * *(uint *)&ept filtered bin8; 
asm mul _cxdx, #EPTFK1; 
asm shraT .cxdx, #8; 
ept.fi Itered.binS » *(int *)&_c*; 

cx * net enginejxt trq; 
~bx ■ 256"- EPTFIC1; " 
asm mul .cxdx, .bx; 
ept.fi Itered.binS *(int *)*.cx; 



/* BIN 8 */ 
/* BIN 16 */ 
/* BIN 8 V 
/* save partial result */ 

/* BIN 0 V 

/* 1 BIN 8 - EPTFK1 */ 
/* BIN 8 */ 

/* sun is final result V 



/* 


8IN 4 


V 


/* 


SIN 8 


V 


/* 


BIM 12 


V 


/* 


BIN 8 


V 


/* 


BIN 8 


*/ 


/* 


BIN 0 


V 


/* 


1 BIN 3 - 


IS FK1 */ 


/* 


BIN 8 


V 


/* 


BIN 8 


V 



eng_percent_torqMe.f i I tared ■ ( char ) ( ept.f i I t ered_b i n8 » 8); 

/** input.shaft.ecctl.calculated « dos.fHtered * gear-ratio **/ 

cx ■ tm.tbl.gear.ratlotdestlnation.gear ♦ GR.OFS); /* 8IN 8 */ 
"bx ■ *(uTnt *)&dos filtered; " /* BIN 0 */ 

asm mul cxdx, bx;~ /* BIN 8 V 

asm shrat .cxdx, #8; /* BIN 0 V 

input.shaft.accel.calculated * *(int *)&_cx; 

/*** calculate filtered input and output shaft speeds for AutoSplit ***/ 

/*** determine os_based.on.rcs variable ***/ 
if (output speed <~1000)" 
< 

bx = aux speed; /* BIN 0 */ 

"cx = BIN"10; /* BIN 10 */ 

"ax * LOW.RANGE; /* BIN 10 */ 

asm mulu "cxdx, _bx; /* make aux.speed BIN 10 */ 

asm divu "cxdx, _ax; /* divide by low range BIN 10 */ 

os based on res * cx; /* BIN 0 */ 

> 

/** input speed filtered = (input speed filtered * IS FK1) ♦ 
(input_speed * (1-IS.FK1) **/ 

ax = (is filtered bin8 » 4) ; 
"cx = IS.FK1 ; 
asm mulu _axbx, _cx ; 
asm shrl .axbx, #4 ; 
is.filtered _partiat_1 = _axbx ; 

cx = input speed ; 
lax s 256 -"lS_FK1 ; 
asm mulu .axbx, _cx ; 
is_f iltered_part7al_2 » .axbx ; 

is_f iltered.bin8 =» is.f i ltered.partial.1 ♦ is.f i I tered_partial_2 ; 

input_speed_filtered = (unsigned int)( is.f i ltered_bin8 » 8); /* BIN 0 V 

/** output speed filtered = (output speed filtered * OS FK1 ) ♦ 
~ (output.speed * (T-0S.FK1) **/ 

ax = (os filtered bin8 » 4) ; /* BIN 4 */ 

^cx = 0SJK1 ; " /* BIN 8 */ 

asm mulu" axbx, cx ; /* BIN 12 */ 

asm shrl "axbx, 14 ; /* BIN 8 V 

os.fi ttered .parti a 1.1 = _axbx ; /* BIN 8 */ 

if (output.speed < 250) 

_cx * os~based.on_rcs; /* BIN 0 */ 

else 

.cx * output.speed ; /* BIN 0 */ 

ax » 256 • 08 FK1 ; /* 1 BIN 8 - OS FK1 */ 

asm mulu axbx7 cx ; /* BIN 8 */ 

os.filtered j»rtTal_2 » _axhx ; /* BIN 8 */ 

os_filtered_bir»8 « o*_f1ltered.pactfaM ♦ os.f i ltered_partial.2 ; 

output_speed.fi I tared « (unsigned int)(os.f i ltered_bin8 » 8); /* BIN 0 V 

/** input_speed_accel.fi I tered ■ (1nput.speed_accel_f i Itered * DISFK1 ) ♦ ( input.ahaft.accel * (1-DISFK1) **/ 

cxdx » *(ulong *)Wis filtered bin8; /* BIN 8 */ 

asm shral cxdx, #4; " /* BIN 4 (.cx) */ 

asm mul cxdx, #DISFK1; /* BIN 12 */ 

asm shraT .cxdx, #4; /* BIN 8 V 

dis.fi Itered.bi n8 » *(long *)&.cxdx; 7* save partial result */ 

cx » *(uint *)&input speed.accel; /* BIN 0 V 

"bx » 256 - 0ISFK1; " /* 1 BIN 8 - 0ISFK1 */ 

asm mul .cxdx, .bx; /* BIN 8 V 

dis.f i Itered.bi n8 *(long *)4.cxdx; /* sum is final result */ 

input.speed.accel.fi Itered * (int)(dis.f i ltered.bin8 » 8); /* BIN 0 V 



/** determine state of clutch **/ 

if (engine_speed > input_speed) 

clutch^sTip^speed ■ engfne_speed • input_speed; 
else 

clutch_slip_speed * input_speed - engine_speed; 

if (clutch slip speed > 200) 
clutch_state~= DISENGAGED; 
else 

if ((engine_speed > 800) && (low_speed_latch == FALSE)) 
clutch state = ENGAGED; 



/** determine desired percent torque needed for zero torque at flywheel **/ 



if ((accelerator_pedal ^position < 2) && 
(clutch_state ENGAGED) && 
(current_gear « 0) && 
(input speed filtered < 1100) && 
(((englne.control « OVERR I DE_D 1 SABLED ) U 
(low_speed_latch « FALSE) &ft (current_gear == 0)) || 
(output_speed_f iltered < 20))) 
percent_torque_accessories = engj>ercent_torque_f i Itered; /* get at idLe 
#endi f 

percent_torque_accessories = 3; /* force value for now */ 
needed jse re ent_for_zero_f lywheei^trq = percent_torque_accessories ♦ 



overal l_error = ((signed int)( input_speed_f i Ltered) - (signed int)(gos)); 



#if (0) 



nominal_f riction _pct_trq; 



> 




\ 



#pragma EJECT 




i ********************************* 



* Function: connunicate_with_driveline 

* Description: 

* This is the periodic task which controls the actions of the engine 

* by defining mode of control and controlling speed and torque output 

* levels depending upon the control function being performed. This task 

* is also intended for control of other drivel ine components (not yet 

* named) which may be available in the future. 

★♦♦a********************************************************************/ 

void communicate wi th_dri veline(void) 
C 

i ni t i a I i ze jdr i vel i ne_dat a( ) ; 

x start_periodic(); 

while (1) 

t 

cont rol_eng i ne_compress i on_brake( ) ; 

determine_gos(); /* calculate (G)ear times the (Output (S)haft V 

determine_shiftabi I i ty_variables(); 

if (engine communication active) 
{ 

if (<desired_sync_testjnode == TRUE) && (output_speed_f i Itered < 100)) 
cont rol_eng i ne_sync_test jnode( ) ; 

else 

{ /* start of normal engine_commands switch */ 

switch (engine commands) 
i 

case ENGINE_PREDIP: 

c on t r o I _eng i ne_pr ed i p( ) ; 
break; 

case ENGINE.SYNC: 

c on t r o 1 _eng i ne_sync ( ) ; 
break; - 

case ENG I NE_RECOVERY : 

control_engine_recovery(); 
break; 

case ENGINE JDIE: 

controlling ine_id I e(); 
break; 

case ENGINE_START: 

control_engine_start(); 
break; 

case ENGINE.FOLLOUER: 
default: 

control_engfne_foUower(); 

break; 

> 

> /* end of normal engine_conmands switch */ 

switch (eng brake command) 
C 

case ENG_8RAKEJ)FF: 

retarderjrontrol = T0RQUE_C0NTROL ; 
desired_retarder_pct_trq ■ 0; 
break; 

case ENG BRAKE FULL: 

retarder_control * TORQUE ^CONTROL ; 
desired_retarder_pct_trq « -100; 
break; 

case ENG_BRAKE_1DLE: 
default:" 

retarder_control » OVERR I DE_0 I SABLEO ; 



desired retarder jpct trq • 0; 
break; " 

> 

) 

else 

engine_status ■ EHGIKEJIOTJ>ReSEMT; 

/* store old value for use in u control_engine_fol lower" function 
accelerator _pedal jxsition_old ■ accelerator_pedal_posi t ion; 

x.sync _per i od i c (US J>ER_100P > ; 

end^periodicO; 



« Unpublished and confidential. Mot to be reproduced, 

• disseminated, transferred or used without the prior 

• written consent of Eaton Corporation. 
* 

* Copyright Eaton Corporation, 1994 

* All rights reserved. 
* 



* Filename: pri».L«.c«6 (AutoSplit) 
* 

* Description: 

* The (nodules contained within this compilation unit are 

* intended to implement functionality of the Process System 

* Input Signals task defined in the design documention. 

* In general, Analog to digital conversions are started on 

* PortO. The necessary hardware initialization and variable 

* initial iztion for inputs on PortO are handled. The switch 

* inputs are captured to avoid conflict with AD conversions 

* and all necessary scaling and error check for these inputs 

* is conducted. 
* 

* Part Number: <none> 
# 

* SLog: ? 
* 

* Rev 1.1 19 Hay 1994 11:32:26 markyvech 

* Converted for use with AutoSplit ECU2 
* 

* Rev 1.0 12 Sep 1991 08:04:26 amsallen 

* Initial revision. 
* 

**************************************************"^ 



^ ************************************************************************ 
* 

* Header files included. 
* 

************************************************************************/ 

^include <exec.h> /* executive information */ 

include <kr sfr.h> /* KR special function registers */ 

include <kr~def.h> /* KR definitions / 

^include <c regs.h> /* KR internal register definitions */ 

#include <wwslib.h> /* world wide software definitions */ 

#include "pr s i s.h" /* process system input signal information */ 

#include "sysgenTh" /* defines the task names and priority */ 

/************************************************************************ 
* 

* #defines local to this file. 



/* Start_AD_Conversions */ 

#define ENABLE A0J>TS_SCAN 0X20 
#define ENABLEJtDJSR 0X20 

#define PERI0O 10U /* 10ms *' 

#define RKM PERI0O SOU /* 50ms */ 



/**********************-******. 

* 

* Constants and variables declared by this file. 



/* Analog Inputs on PortO */ 

int ignition_volts; 
int splitterjwsition; 

#define I GM I T 1 0H_V0LTS_CHANNEL_RESULT 1 



#define SPL I T*TER_PGS_CHANNEL_RESULT 
#define COM VERS I OM_T I ME Oxef 

^define C0NVERT_8 8 

#define CONVERT IGNITIQMJ/OLTS 
#define UNUSED CHANNEL J 
#define UNUSED CHANNEL^ 
#define UNUSED CHANNEL_3 
#define UNUSED CHANNEL^ 
#define UNUSED CHANNELj 
#define UNUSED CHANNEL 6 
#define CONVERT SPLITTER_POS 
#define STOP CONVERSION 
#define START CONVERSIONS 



15 

/* 
/* 
/* 
/* 



for state tiw 

sample time 
convert tin 



« 125 nsec: */ 
» 3.6250 usee V 
= 20.1875 usee */ 



scan and convert 8 channels 



( norm mooe 
("norm'mooe 
(~norm"mooe 
(~norm"mooe 
<~norm~mooe 
<~norm"mooe 
<"norm"mooe 
(~norm"mooe 

0x00 
ad command 



10 BIT MODE 
"10~BIT~MOOE 
"10~BIT~MOOE 

"io"bit"mooe 
"io"bit"mooe 
"io~bit~mooe 
'io~bit"mooe 
'io"bit"mooe 



strt 
"strt 
"strt 
"strt 
"strt 
'strt 
"strt" 
"strt 



CONV 
"CONV 
CONV 
CONV 
"CONV 
"CONV 
"CONV 
"CONV 



CHNL_0) 
"CHNLJ ) 
CHNL 2) 
CHNL~3) 
CHNL_4) 
CHNL 5) 
"CHNL~6) 
CHNL 7) 



= CONVERT J GN I T I ON_VOLTS 



/* table containing AD_result and AD_Conmand values after PTS scan V 
unsigned int AD_Table[T6] ; 



/* AD SCAN PTS CONTROL BLOCK LOCATION 
ad_ptsb_type AD_Con_Block; 
Spragma Tocate(AD_Con_Block=0x01F8) 
#pragma pts(AD_Con_Block = 5) 



/* locate pts control block */ 
/* set pts vector 5, A/D done V 



#pragma eject 



* Function: Initial ize_Input_Signals 
* 

* Description: 

* This routine initializes the A/D converter. It sets the A/0 to 

* run in PTS scan mode, 10bit conversion. The PTS control block is 

* set up and the Command/result table is initialized. 
* 



void InitializeJnput_Signals<void) 

/* if we knew when the first speed packet arrived, we could initialize 
with those values, since we don't, be safe and use zero. */ 



AO Table [0] 

AD~Table[1] 

A0~TableC2] 

AD~TableC3] 

AD~Table[4J 

AD~Tablet5] 

A0~Table[6J 

AD~Tablet7] 

AD~Table[83 

AD~Table[9] 

AD~Table(10J 

A0~Table[11] 

AD~Table[12] 

AD~Table[13J 

AD~TabletH] 

AD~Table[15] 



= UNUSED_CHANNEL_1 ; 
= OxOOOOj 

= UNUSED_CHANNEL_2; 
= OxOOOOj 

= UNUSED_CHANNEL_3; 
= OxOOOOj 

= UNUSED_CHANNEL_4; 
= OxOOOOj 

= UNUSED CHANNEL 5; 
= OxOOOOj 

= UNUSED_CHANNEL_6; 
= OxOOOOj 

= CONVERT SPLITTERJ>OS; 
= 0x0000;" 
= STOP_CONVERS10N; 
= 0x0000; 



AO Con Block.cnt = CONVERT_8; 
AD~Cor.~Block.ctrl = _AD_MOOE L$_D_UPDT; 



AD Con Block.s d = AD_Table; 
AD~Con~BLock.reg = (void *)&_ad_result; 

ad time = CONVERSIONJIME; 
"acftest = NO OFFS; 
j3ts_select &= ~<_PTS_ADDONE_BlT); 



/* place holder for channel 1 
/* I GN I T I QN_VOLTS_CHANNEL_RE$ULT 
/* place holder for channel 2 
/* UNUSEDJ_RESULT 
/* place holder for channel 3 
UNU$ED_2_RESULT 
place holder for channel 4 
UNUSED_3_RESULT 
place holder for channel 5 
UNUSED_4_RESULT 
place holder for channel 6 
/* UNUSED_5_RESULT 
/* Command convert splitter pos 
/* UNUSED_6_RESULT 
/* conmand~to Stop conversions 
/* SPLITTER POS CHANNEL RESULT 



/* 
/* 
/* 
/* 
/* 
/* 



V 
*/ 
*/ 
*/ 
V 
*/ 
V 
*/ 
V 
*/ 
V 
*/ 
V 
V 
V 
V 



/* A/D mode bits 0,1 of PTS_CONTROL 
/* always set to 3h bit 2 = 0 
/* S/D update at end of cycle 
/* bit 5 always 0 
/* Set mode for AD SCAN 

/* Load s d with ADJTable address 
/* Load reg with AD~Result address 



/* Disable test mode */ 
/* Disable AD PTS */ 



#pragma eject 



* Function: AD_ISR 

* ~ 

* Description: 

* This interupt service routine resets the PTSCOUNT, pts_sd and pts_re$ 

* for another PTS_Scan A/0 cycle. It also readies a task to run when 

* a PTS cycle has"completed. 
* 

************************************************************************/ 

#pragma interrupt(ADJSR=5) 

void AO ISR(void) 

C 

x start isrO; 

AO Con Block. cnt = C0NVERT_8; /* Reset pts count for next cycle */ 

AD~Con~Block.s_d = AD_Table; /* Reset table pointer to start of table 

AD~Con~Block.reg = (void *)&_ad_result; 

x_ready(PROCESSJNPUT_$lGNALS); /* Ready pr_s_i_s task */ 

x~end isr<); 

> 



#pragma eject 



* Function: S tar t_AD_Convers ions 
* 

* Description: 

* This function initializes the input signal processing function 

* if it has not already been done, and then startes the PTS Scan 

* of the AD channels by sending the appropriate command to the 

* ad command register. 



void Start_AD_Conversions(void) 

C if <( int mask & ENABLE_ADJSR> « 0 ) 

InTtializeJnput_Signals(); /* Set up AD table for PTS * 

_pts select |= ENABLE ADJ>TS_SCAN; 
Jntjnask |= ENABLE_ADJSR; 

x_pr ea rm_s t i mu I us ( ) ; 

START CONVERSIONS; /* Start a conversion, initiate the PTS cycles */ 
x wait stimulusO; /* ADJSR will ready task when PTS is complete */ 



#pragma eject 



* 

* Function: process_input_signals 
• 

* Description: 

* This is the periodic task which starts the analog conversions on PortQ. 
* 

************************************************************************/ 

void process J nput_signals( void) 
C 

x startjjeriodicO; 

while <1> 

i 

Start_AD_Conversions< ); 

/* Clean up and scale AO values */ 

ignition volts = scale sys tem_ad J r^*Jts( IGNITION J/OLTAGE); 
splitterjx>sition = scale_systero"ad - inputs(SPlITTER - POSITION); 

/* x syr*j>eriodic<PERI00*1000); */ 
x sync_periodic(RKM_PERI00*1000>; 

> 

x end_periodic(); 

> 



#pr agma eject 



Function: sea I e_syste»_ad_ inputs 



Description: 

This function removes the channel, status and reserved bits from 
the raw AD values, and performs all necessary scaling and error 
checking for the analog inputs on PortO. 



*********** 



nt scale_system_ad_inputs(char Channel) 



16 
16 



int ScaledJ/alue * 0; 
uint voltsj»*\_bit; /* BIN 
uint units_per~bit; /* BIN 
#define TWELVE~VOLT FULL-SCALE 
#define TWENTY~FOUR~VOLT_FULL_SCALE 
#define DISTANCE FULL-SCALE 



*/ 

V 



22.46 
40.49 
100 



/* 
/* 
/* 



volts 
volts 



*/ 
*/ 

V 



volts_per bit = (uint )((TWELVE VOLT FULL SCALE*65536/1023)*0.5);. 
units_perj>it = (ui nt)((D I STANCE JUU_SCALE*65536/1023)+0.5); 

switch (Channel) 
i 

case 0: /* IGNITION VOLTAGE V 

cx - AD TableCIGNITION VOLTS CHANNEL RESULT] » 6? 
asm mulu" cxdx, vol tsjper_bit; /* volts, BIN 16 <_dx, BIN 0) */ 
Scaled J/aTue = *(int *)&_dx; 
break; 

case 1: /* UNUSED */ /* to be completed when a product requires it 
ScaledJ/alue = (0); 
break; 

case 2: /* UNUSED */ /* to be completed when a product requires it 
ScaledJ/alue = (0); 
break; 

case 3: /* UNUSED */ /* to be completed when a product requires it 
ScaledJ/alue = (0); 
break; 

case 4: /* UNUSED */ /* to be completed when a product requires it 

ScaledJ/alue = (0); 
break; 

case 5: /* UNUSED V /* to be completed when a product requires it 
ScaledJ/alue = (0); 
break; 

case 6: /* UNUSED */ /* to be completed when a product requires it 
ScaledJ/alue = (0); 
break; 

case 7: /* SPLITTER POSITION */ 

cx = AD Table£SPLITTER_POS_CHANNEL_RESULT3 » 6; 
asm mulu" cxdx, units_per_bit; /* distance, BIN 16 (_dx, BIN 0) 
Scaled J/aTue = *<int *)&.dx; 
break; 

default: 
break; 

> 

return (ScaledJ/alue); 



* 

* Unpublished and confidential. Mot to be reproduced, 

* disseminated, transferred or used without the prior 

* written consent of Eaton Corporation. 
* 

* Copyright Eaton Corporation, 1993-94. 

* All rights reserved. 



* 

* Filename: set jgear.c96 (AutoSpUt) 
* 

* Description: 

* This module is the periodic task H select_gear«. It assigns values 

* to destination_gear_selected as a function of selectedjnode, input 

* and output shaft speeds, and driver selections (dccjnanuaMnput). 

* Shift parameters are in the data structure shf_tbl. Before setting 

* destination_gear_selected, gears are checked with avai lable_gear<). 
* 

* Part Number: <none> 
* 

* $Log: R:\ashift\vcs\sel_gear.c9v % 
* 

* Rev 1.8 21 Feb 1994 15:07:14 schroeder 

* Replaced shif tabi lityjnode with new flag, engine_brake_avai lable. 
# 

* Rev 1.0 29 Jul 1993 16:40:26 schroeder 

* Initial revision. 
* 

************************************************************************/ 

^************************************************************************ 
* 

* Header files included. 

************************************************************************/ 



/* 
/* 
/* 
/* 
/* 
/* 
/* 
/* 



executive information */ 
c registers */ 

contains common global defines */ 
control system */ 

defines interface to j1939 control module 
driveline commands information */ 
select gear */ 
shift table definition */ 



U include <exec.h> 
# include <c_regs.h> 
#include <wwslib.h> 
# include "cont sys.h" 
^include con j 1939. h» 
^include ,, drl_cmds,h H 
#include "se^gear.h" 
#include »shf_tbl.h» 
#include "trn tbl.h" 
^include »calc_spd.h M 
#include "trns~act.h" 
#pragma noreentrant 

/************************************************************************ 



/* (system) transmission table definition */ 



* #defines local to this file. 



#define US_PER_LOOP 40000U 
#define I N I T I AL_START_GEAR 1 



* Constants and variables declared by this file. 
* 

**************************** 



/* public */ 



char des tinati on_gea reelect ed; 

char dest i nat i on_gear ; 

char f lash_desired_allowed; 

char desired_gear; 

char desi red_gear_dn; 

char desi red_gear_up; 

uchar coast ing_latch; 

uchar sel_gear_cntr1; 

ucha r se I "gea r_cnt r 2 ; 

uchar sel~gear_cntr3; 



/* debug use - delete later */ 
/* debug use - delete later */ 

debug use * delete later V 
debug use - delete later */ 
debug use - delete later */ 



uchar sh i f t J ni t_type; 

uint lpf_output_speed; 

int dos_predicted; /* BIN 0 */ 

int dos_prdtd I in no jake; /* SIN 0 */ 



/* local V 

/* filter weights for the "mda" output speed filter */ 
static register uchar w1; 
static register uchar u2; 
static register uchar w3; 
static register uchar w4; 

/* shift table (define and extern in shf_tbl.h) */ 
struct shf_tbl_t shf_tbl; 

/* default shift table values */ 
const struct shf_tbl_t ini_shf_tbl = 

1200, /* aut_dwn_rpm V 

1000, /* aut_min_dwn_rpm */ 

1700, /* aut~up_rpm V 

0 # /* best_gr_offset */ 

50, /* dwn_offset_rpra */ 

100, /* dwn~reset_rpro */ 

400, /* dwn~timer~offset_rpra */ 

40, /* hysteresis_rpm */ 

1850, /* man_dwn_sync_rpro */ 

700, /* man_up_sync_rpra */ 

1900, /* rated_rpm */ 

150, /* up_offset_rpm */ 

125, /* up~reset_rpm */ 

200*, /* up~timer~offset_rpm V 

0, /* dwn_accel V 

8, /* up_accel */ 

3000, /* offset_time */ 
(uintXO. 25*256), /* aut_upjxt */ 

10, /* min_output_spd */ 

1 ( /* max~start_gear */ 

0 ( /* padbytel */ 

196, /* k1_ability, min-f t/rev-sec, BIN 12 */ 

431 ' /* axle ratio_cal, BIN 7 */ 

383, /* gcw k1, rev/sec-min-f t, BIN 0 */ 

2437, /* gcwjc2, rev/sec'2, BIN 7 */ 

1325, /* calc_startj>oint, rpm, BIN 0 */ 

107, /* k6_ability, min- Ib-f t-sec/rev, BIN 8 */ 

1500, /* auto_up_lo_base, rpm, BIN 0 */ 

1100, /* auto~dn~lo_base, rpm, BIN 0 */ 

100,' /* auto~rtd_offset, rpm, BIN 0 */ 

1000, /* lowest_engage_rpm, BIN 0 */ 

0, /* padwordl V 

0 /* padword2 */ 

>; 

/* local -- initialized at start of task by select_gear */ 

/* shift points with anti-hunt offsets; referenced by auto_downshift and 

auto_upshift; set by get_automatic_gear and select_gear */ 
uint upshift j»int; 
uint downshiftjxnnt; 

/* lower limit for gear selections */ 
char Lowest_forward; 

/* indicate direction of a get_automatic_gear shift; referenced by 

getjnanual_gear; cleared by~select_gear when shift complete */ 
char automat ic_sip; 

/* used in the determination of shift jx>ints based on throttle position * 
static uint auto_up_rpm; 
static uint auto_dn_rpm; 
static uint auto_up_of fset_rpm; 
static uint auto_dn_off setj-pm; 



/* delay counter for ant i -hunt */ 
static uchar antihunt_counter; 



/* gross combined weight calculations */ 

#define ZERO SPEED TIME LIMIT 4500 /* 3 m\n a 0.040 period */ 

#def ine VALID OLD DATA TIME 100 /* 4 sec a 0.040 period */ 

^define MAX VEHICLE WEIGHT 100000 /* 100,000 lbs */ 

#define DOS~OFFSET TnIT 48 

^define ENG DECEL LOW LIMIT -350 /* rpm/s */ 

^define ENGJ)ECELJ.PF~ 224 /* exp<-2pi(0.53Hz)(0.040s)) = 0.875 (8IM 8) V 
#pragma eject 



* Function: mda jxitput_f i I ter 

* ~" 

* Description: 

* This is a one pole LPF with a variable coefficient. The magnitude 

* of the coefficient is directly related to the acceleration content 

* of the speed sample and the frequency. 
* 

************************************************************************/ 



tatic void mda_output_f i Iter(void) 

tfdefine K1 8 
#define K2 24 
#define K3 48 
#define K4 160 

static register uint osjielta^speed; 
static register uchar weight; 

if (Ipf output speed > output_speed> 

os_delta_speed = lpf_output_speed - output_speed; 
else " 

os_delta_speed = out put_s peed - lpf_output_speed; 

if (os_delta speed <= K1) /* delta <= 200 rpm/s */ 

i 

if <w1 > 1) --w1; 
if (w2 < 5) ++w2; 
if (w3 < 6) ++w3; 
if <u4 < 7) ++w4; 
weight = w1; 

else if (os delta speed <= K2) /* 200 rpm/s < delta <= 600 rpm/s */ 

if <w1 < 4) ++w1; 
if (w2 > 2) -w2; 
if <w3 < 6) *+w3; 
if (w4 < 7) ++w4; 
weight = w2; 

else if (os delta_speed <= K3) /* 600 rpm/s < delta <= 1200 rpm/s */ 
C 

if (wl <4) ++w1; 
if (w2 < 5) ++w2; 
if (w3 > 3) -w3; 
if (w4 < 7) ++w4; 
weight = w3; 

else if (os delta_speed <= K4) /* 1200 rpm/s < delta <= 4000 rpm/s */ 
t 

if (wl < 4) ++w1; 
if (w2 < 5) ++w2; 
if (w3 < 6) +*w3; 
if (w4 > 3) --w4; 
weight = w4; 

else /* 4000 rpm/s < delta */ 

C 

if (w1 < 4) ♦♦wl; 
if (w2 < 5) ++w2; 
if (w3 < 6) +*w3; 
if (w4 < 7) ♦♦wA; 
weight = 7; 

> 

Ipf output_speed = lpf_output_speed ♦ 

Toutput speed » weight) - ( lpf_output_speed » weight); 

> 

#pragma eject 



* Function: ne*_input_speed 



Description: 

A utility function that returns the input shaft speed expected if 
"gear" was engaged with the present output shaft speed. 



static uint new_input_speed(char gear) 

/* new input speed = Ipf output_speed * gear_ratio */ 

ax = trn tbl.gear ratioTgear + GR_OFS]; /* BIN 8 */ 

Ism mulu "axbx, Ipf output speed; /* BIM 0+8=3 <_axbx> */ 

asm shrl >cbx, #8;" /* BIN 8»=0 (jwO */ 
return ax; 

> 



#pragma eject 



* Function: auto_upshift 
* 

* Description: 

* This boolean function returns true when automatic upshift 

* conditions have been met. 



static int auto_upshift(void) 
C 

/* if (input speed > upshif t_point) */ 

if <(gos > upshiftjx>int) && <output_speed_f i ttered > 120)) 

if (engine - conmunication_active) 

/* if <(!shiftability_hold) && (!shiftabi I ityjioldjl )) V 
sel_gear_cntr2++; 
return 1; 

> 

> 

return 0; 



#pragma eject 



* Function: auto_downshift 

* ~~ 

* Description: 

* This boolean function returns true when automatic downshift 

* conditions have been met. 
* 

************************************************************************/ 

static int auto downshif t(void) 
C 

/* if (input_speed < downshiftjx>int) */ 
if Cgos < downshift_point) 
€ 

return 1; 

> 

return 0; 

> 

#pragma eject 



* Function: deteraine_autosplit_type 
* 

* Description: 

* This function is used to determine if the impending shift type is 

* MANUAL or AUTO. 



static char determine_autosplit_type(char passed_new_gear, char passedjni tial_gear) 
C 

register char new_gr s passed_new_gear; 
register char init_gr = passed_ini tial_gear; 



if ((shift in_process 

if ( (new_gr == 
(new_gr == 
(new_gr == 
(new_gr = = 
(new_gr == 
(new_gr == 
(new_gr == 
(new_gr == 
(new~gr == 
(new_gr == 
shift init_type 



FALSE) || (engine_status « ENGINE_RECOVERYJ400E)) 



&& 



1 
3 
5 
7 
9 

10 && 
8 && 



&& 
&& 



imt_gr == 

init_gr « 

init_gr == 

init_gr » 

ini t_gr == 

init_gr == 

initjjr == 

6 && init_gr == 

4 && init^gr == 
2 && init gr 
AUTO; 



2) 




/* 


dn 


*/ 


4) 




/* 


dn 


*/ 


6) 




/* 


dn 


V 


8) 




/* 


dn 


V 


10) 




/* 


dn 


V 


9) 




/* 


up 


V 


7) 




/* 


up 


*/ 


5) 




/* 


UP 


V 


3) 




/* 


up 


V 


D) 


/* 


up 


V 



else 

shift init type = MANUAL; 

) 

if ((init gr <= 4) && (new_gr < init_gr)) 

shift_Tnit_type = MANUAL; /* prevent coasting auto downshifts in tow gears */ 

> 



#pragma eject 



* Function: get_automatic_gear 
* 

* Description: 

* This function returns an "automatic" forward gear selection. It 

* also performs driver requested shifts (manualj-equest) restricted 

* by shaft speeds. If no gears are available in required direction, 

* initial_gear is returned. 



static char get automatic_gear(char ini tial_gear, char manual_request) 
C 

register char new_gear = ini tial_gear; 

if (automatic sip !- -1) 
( 

sel_gear_cntr3+>; 

/* initiate or continue an automatic upshift: search up from lowest_forward \ 

(fastest input speed) for the first available gear that will provide input 

speed below a value (approx upshift rpm, minus an offset for gears that will i 

result in a net downshift) */ 
for (new gear = lowest_forward; 

(new_Tnput_speed(new_gear) > (upshif t_point - 

(new gear < initial gear ? ?' 
(shf tbl.up_offset_rpm ♦ auto_dn_of fset_rpm) : shf_tbl -best_gr_of fset))) 

&& (new_gear <= trn_tbl .highest_forward); 

++new_gear) 

t 

/* if we ran out of gears and the highest is available, it must be due to speed; 

pick highest_forward, input speed will be slower than it is now */ 
if (new_gear > trn_tbl .highest_forward) 

new_gear * trn_tbl .highest_forward; 

0 

desired_gear = new_gear; 
desired_gear_up = new_gear; 

determi ne_aut ospl i t_type( new_gear , ini t i a l_gear ) ; 

/* if in gear manual or the selection will underspeed, pick initial_gear */ 
i\f (((shift_init_type == MANUAL) && ( transmission_position == INJ3EAR)) || 
(( automat ic_sip == 0) && (new_gear <« ini tial_gear))) 
new_gear = initial_gear; 
else 
t 

/* indicate gear change and adjust downshif t _point */ 

automatic_sip = +1; 

auto_up_of fset_rpm = 0; 

if (shift init'type == AUTO) 

auto_dn~offset_rpm = shf_tbl ,dwn_timer_of fset_rpm; 
else 

auto dn offset_rpm = 0; 

> 

> 

if ((automatic sip != 1) && (initial gear > lowest_forward)) w 
C " C? x 

/* initiate or continue an automatic downshift: search down from 

highest_forward (slowest input speed) for the first available gear that will 
provide~input speed above a value (approx downshift rpra, plus an offset for 
gears that will result in a net upshift) */ 
for (new_gear = trn_tbl .highest_forward; 

(new Input speed(*new gear) < (downshiftjxnnt ♦ 

(new_gear > initial_gear ? shf_tbl .dwn_of fset_rpm : shf_tbl.best_grj>ffset))) 
&& (new^gear >= lowest_forward); 
--new_gear) 

9 

/* if we ran out of gears and the lowest is available, it must be ote to speed; 

pick lowest_forward, input speed will be faster than it is now */ 
if (new_gear <~l owes t_f or ward) 

new_gear = lowest_forward; 

desired_gear_dn = new_gear; 

if (desired_gear_dn < ini tial_gear) /* must be a down shift or else it */ 




desired_gear = new_gear; 



/* wrongly cancel the desiredup pick. 



deten»ine_autosplit_type(ne«_gear l initial_gear); 

/* if in gear manual or the selection will overspeed, pick initial_gear */ 
if (((shift init_type == MANUAL ) && (transmissionjx>si tion == I M_GEAR ) ) || 
(( automat ic_sip == 0) && (new_gear >- ini tiat_gear))) 
new_gear = ini tial_gear; 
else 

/* indicate automatic gear change and adjust upshif tjx>int V 

automat ic_sip » -1; 

auto dn offset_rpm = 0; 

if (shift init_type == AUTO) 

auto upj>ffset_rpm = shf_tbl.up_timer_of fset_rpm; 
else 

auto_up_of fset_rpm = 0; 

> 

> 

return new_gear; 

> 

#if (0) 

**** This is the select gear based on AutoShift code **** 



#pragma eject 



* Function: get_automatic_gear 
* 

* Description: 

* This function returns an "automatic" forward gear selection. It 

* also performs driver requested shifts (manual_request) restricted 

* by shaft speeds. If no gears are available in required direction, 

* initial_gear is returned. 

* — 

************************************************************************/ 

static char get automat ic_gear( char ini tial_gear, char manual_request) 
register char new_gear = ini tial_gear; 

if (((automatic sip — 0) && auto_upshif t<>) || ( automat ic_sip > 0)) 
C 

sel_gear_cntr3++; 

/* initiate or continue an automatic upshift: search up from I owes t_f or ward 
(fastest input speed) for the first available gear that will provide input 
speed below a value (approx upshift rpra, minus an offset for gears that will 
result in a net downshift) V 

for (new_gear = I owes t_f orward; 

( new_Tnput_speed( new_gear ) > (upshif t_point - 
(new gear < initial gear ? 

(shf_tbl.up_offset_rpm + auto_dn_of fset_rpm) : shf_tbl .best_gr_of fset))) 
&& (new_gear <= trn_tbl .hi ghest_f orward); 
♦+new_gear) 

/* if we ran out of gears and the highest is available, it must be due to speed; 

pick highest_forward, input speed will be slower than it is now */ 
if (new_gear > trn_tbl ,highest_f orward) 

new_gear = trn_tbl ,highest_f orward; 

desired_gear = new_gear; 

determine_autosplit_type(new_gear, initial_gear); 

/* if in gear manual or the selection will underspeed, pick initial_gear */ 
if ((shift_init_type == MANUAL ) && ( transmissionjx>si tion == INJiEAR)) 

new_gear = initial_gear; 
else 
C 

/* indicate gear change and adjust downshif t_point */ 
automat ic_sip = +1; 
auto_up_of fset_rpm = 0; 
if (shift_init~type == AUTO) 
auto_dn~of f set_rpm = shf_tbl ,dwn_t imer_of f set_rpm; 

else 

auto dn_of fset_rpm = 0; 

> 

> 

else if (((automatic sip == 0) && 
(auto_downshift<)) && 
(initial_gear > I owes t_f orward)) || 
(automatTc_sip < 0)) 

/* initiate or continue an automatic downshift: search down from 

highest forward (slowest input speed) for the first available gear that will 

provided nput speed above a value (approx downshift rpm, plus an offset for 

gears that will result in a net upshift) */ 
for (new_gear « trn_tbl .hi ghest_f orward; 

(new Input speedTnew gear) < (downshif t_point ♦ 

(new_gear > initial_gear ? shf_tbl ,dwn_of fset_rpm : shf_tbl .best_gr_of f set))) 

&& (new~gear >= lowest~forward); 

--new_gear) 

* 

/* if we ran out of gears and the lowest is available, it must be due to speed; 

pick lowest forward, input speed will be faster than it is now */ 
if (new_gear < lowest_f orward) 

new_gear = I owes t_f orward; 

desired_gear = new_gear; 

determine_autosplit_type(new_gear, initial_gear); 

/* if in gear manual or the selection will overspeed, pick initial_gear */ 



if ((shift_init_type «■ MANUAL) && (transarissionjaosi tion » I N_GEAft ) ) 

new_gear » initial_gear; 
else 

/* indicate automatic gear change and adjust upshiftj»int */ 
automat ic_sip * -1; 
auto dnj)ffset_rpm = 0; 
if (shiftjnit_type « AUTO) 
auto_upj>ffset_rpm » shf_tbl .up_timerj>f fset_rpm; 

else 

auto up offset_rpm = 0; 

> 

> 

return new gear; 

> 

#endif 

#pragma eject 



* Function: det ernn ne_dest i nat i on 

* ~ 

* Description: 

* This function uses "coast ing_l at ch" to determine if a coasting or 

* skip shift is being attempted. When sensed, the latch is used in 

* the determine_base_pts function to effect the base shift points, 
• 

void determine dest i nat ion< void) 
< 

/* if coasting in neutral - force shift points */ 

if <coasting_latch == FALSE) 

if ((last known_gear - destination_gear_selected) > 1) /* multi downshift 
C 

if ( (dest i nat ion_gear_selec ted == 7) 
( dest i nat ion~gear_selected ==5) 
(destination_gear_selected ==3) 
(dest i nat ion~gear_selected == D) 

C 

des t i na t i on_gear_se lecteoH+ ; 
coasting latch = TRUE; 

> 

> 

else 

if ((destination_gear_selected - last_known_gear) > 1) /* multi upshift 
C 

if (( dest i nat ion_gea reelected == 10) 
( des tination_gea reelected == 8) 
(destination3gear_selected == °> 
(destination_gear_selected == 4)) 

< 

dest i nat i on_gea reelected- - ; 
coasting latch * TRUE; 

> 

> 

> 

> 

else 

if (shift_inj>rocess == FALSE) 
coasting_latch = FALSE; 



#pragma eject 



* Function: determinejnanual_shif t_pts 

* Description: 
« 

static void determinejnanual_shif t_pts(void) 
( 

if (coasting latch == FALSE) 
C 

if (<lastJcnown_gear == 1) 
( lastJcnowrTgear == 3) 
(last~known~gear == 5) 
( last~known_gear == 7) 
<lastJcnown~gear == 9)) 
auto_dn~rpm = 1325; /* manual downshifts */ 

else 

auto up_rpm = 1375; /* manual upshifts */ 

> 

> 

tfpragma eject 



* Function: detennne_base_auto_shi f t_pts 

* Description: 

* This function determines the base up and down shift points based on 

* the position of the throttle. These base points will be used in the 

* calculation of the upshift j»int and the downshi f t_point. 

* The anti -hunting calculations have been moved to this function since 

* these calculations are now throttle dependent. 

************************************************************************/ 

static void determine base auto_shif t_pts(void) 
< 

if (pet demand at cur sp > 0) 

C ~ > 

/* auto up rpm = shf tbl.auto up_lo_base + 

Ush?_tbl.aut_up_rpm - shf_tbl .auto_up_lo_base) * Xthrottle) * 

_cx = shf_tbl.aut_upj-pm - shf_tbl .auto_up_lo_base; 
~bx = pct~demand_at_cur_sp; 
asm mulu _cxdx, _bx; 
asm divu "cxdx, #100; 

auto_up_rpm = shf_tbl .auto_up_lo_base + _cx; 

/* check for RTD requirement V 
if (pct_demand_at_cur_sp > 90) 

auto2up_rpm"*=~shf "tbl . auto_rtd_of f set ; 

/* auto dn rpm = shf_tbl .auto_dn_lo_base + 

(7shf_tbl.aut_dwn_rpm -~shf_tbl .auto_dn_loJ»se) * Xthrottle) 

_cx = shf_tbl ,aut_dwn_rpm - shf_tbl ,auto_dn_lo_base; 
~bx = pct_demand_at_cur_sp; 
asm mulu _cxdx, _bx; 
asm divu _cxdx, #100; 

auto_dn_rpm = shf_tbl ,auto_dn_lo_base ♦ _cx; 

> 

else 

auto_up_rpm = shf_tbl ,auto_up_lo_base; 
auto~dn~rpm = shf_tbl .auto_dn_lo_base; 



determine_manual_shift _pts(); 

if (shift inj>rocess) 
i 

/* reset antihunt_counter */ 
antihunt_counter = 0; 

/* allow the knob display to flashed any new desired gear */ 
flash desired allowed = TRUE; 

> 

else 

/* reset shift in process flags and update antihunt_counter */ 

automatic sip * 0; 

if (antihunt counter < 255) 

C 

♦♦antihunt counter; 
/* flash desired allowed * FALSE; */ 
> 

/* look for upshift anti-hunt reset conditions */ 

if ((antihunt counter * (USJ>ERJ.0OP/1000)) >= shf_tbl .of fset_time) 

/* check for last shift * upshift effects */ 

if (auto_dn_of fset_rpm == shf_tbl .dwn_timer_of fset_rpra) 

au t o_dn_o f f s e t _rpm = shf_tbl -dwn_of f set^rpm; 
else if~((auto_dn~offset_rpm == shObl ,dwn_of fset_rpm) && 

(input_speed_fTltereof> auto_dn_rpm + shf_tbl .dwn_reset_rpm)) 

auto_dn_of fset_rpm = 0; 

/* check for last shift = downshift effects V 

if (auto_up_offset_rpra » shf_tbl .up_timerj>ffset_rpm) 



auto up offset_rpm ■ shf tbl .up_of f set_rp»; 
else if~<(auto up^offset^rpi =* shf_tbl ,up_of f set_rc«) && 

(iriput_speed_fTltereof> auto_up_rp» - shf _tbl . up_reset_rpm) ) 
auto_up_offset_rp* ■ 0; 

/* allow the knob display to flashed the desired gear V 

if (((desired gear > destination gea reelected) && (gos < (upshif tj»int ♦ 25))) || 
((desired'gear < ctestination~gea reelected) && (gos > (downshift_point - 25)))) 
ftashjiesiredjillowed * FALSE;" 
else 

flashjiesiredjillowed s TRUE; 



/* set the shift points based on throttle and determined offsets */ 
upshif t_point * auto_up_rp» ♦ auto_up_offset_rpm; 
downshift_point = auto_dn_rpra - auto_dn_of fset_rpm; 

/* check that the calculated shift point is reasonable V 
if (upshif t_point > shf_tbl .man_dun_sync_rpm) 
upshif t_point = shf_tbl .man_dwn_sync_rpm; 

if (downshiftjwint < shf_tbl .man_up_sync_rp<n) 
downshift_point = shf_tbl .man_up_sync_rpm; 



#pragma eject 



r** ********************** 



* Function: select_gear 
* 

* Description: 

* This is the root function for the periodic task SELECT_GEAR. Each 

* loop begins by checking the manual up/down buttons. Then, based on 

* selected jnode and output shaft speed, a *get_. . ._gear» function is 

* called to update destination_gear_selected. 
* 

************************************************************************/ 



void select gear(void) 
C 

char manual_request; 

static uchar enable_gcw_calc; 

enable_gcw_calc = FALSE; 

shf_tbl = ini_shf_tbl; 

destination_gear_selected = 1; 
desired_gear = 1; 



/♦.current manual request <♦/- 1) V 
/* diagnostic - delete later !!*/ 

/* diagnostic - delete later I!*/ 

/* initialize the shift table V 



/* initialize file scope variables */ 



w1 = 3; 
w2 = A; 
w3 = 5; 
w4 = 6; 

lpf_output_speed = output_speed; 

upshift _point = shf_tbl ,aut_up_rpm; 

downshift _point = shf_tbl ,aut_dwn_rpm; 

auto up offset rpm = shf_tbl .up_timer_of f set_rpm; 

auto~dn~offset~rpm = shf'tbl . dwn_ time r_off set _rpm; 

I owes t_f orward~= INITI AL~START_GEAR ; 

automat ic_sip = 0; 

antihunt^counter = 255U; 

coast ing~latch = FALSE; 

flash_desired_al lowed = TRUE; 

x start_periodic(); 
while (1) 

i mda_output_filter<); /* update our filtered output speed */ 
ma nua I _ request = 0; 
det ermlnej>ase_aut o_sh i f t j>t s( ) ; 

/* set destination_gear_selected from function(s) appropriate for selected jnode */ 

switch(selected mode) 

< 

case REVERSE_M00E : 

case DRIVE MODE: 

if <(forward_last == TRUE) && < low_speed_latch == FALSE)) 

destination^gearjselected = get_automatic_gear<destination_gear_selected ( manual_request); 
determine destinationO; 

sel gear cntrH*; /* debug use only - delete later */ 

> 

break; 

case LOW MODE: 
case HOLD H0OE: 
case NEUTRAL MODE: 
case PARK MOOE: 
case POWER UP MOOE: 
case POWER~DOWN MOOE: 

case DIAGNOSTIC TEST MOOE: . 
/* prevent transient selection upon mode change (these modes ignore it) / 
destination_gear_selected = 0; 
break; 



default: 

/* invalid mode: do nothing */ 
break; 

> 

x_sync_periodic<US_PER_LOOP); 



> 

x end _per iodicO; 

> 



y**************************************** ************* ******************* 
* 

* Unpublished and confidential. Not to be reproduced, 

* disseminated, transferred or used without the prior 

* written consent of Eaton Corporation. 
* 

* Copyright Eaton Corporation, 1991-94. 

* AU rights reserved. 



* Filename: seq_shft.c96 



(AutoSplit) 



* Description: 

* The functions in this file will perform the required system 

* level operations for implementing Sequence Shift. 
* 

* Part Mumber: <none> 
« 

* $Log: R:\aselect\vcs\seq_shft.c9v $ 
* 

* Rev 1.0 12 May 1994 16:26:00 markyvech 

* Initial version 
* 

************************************************************************/ 



/********** 



************************************************************** 



* Header files included. 
* 



#include 
^include 
#include 
#include 
# include 
#include 
include 
# include 
#include 
# include 
#include 



<exec.h> 

<c_regs.h> 

<uwslib.h> 

"cont sys.h" 

»conjT939.h H 

"con^s.h" 

"drrciiids.h M 

M sel~gear.h" 

"shf'tbl.h" 

••trn'tbl.h" 

"trns act.h" 



/* executive information */ 

/* ICR internal registers */ 

/* World Wide Software Library */ 

/* control system information */ 

/* Defines interface to engine communications info 

/* control output signal information */ 

/* drivel ine commands information */ 

/* Contains information relative to engine */ 
/* transmission table information */ 
/* transmission information */ 



^ ************* 
* 



*********************************************************** 

* ^defines local to this file. 
* 

************************************************************************/ 
************************************************************************ 



* publics. 



uchar sq_sh1; /* debug counter - delete later */ 
uchar sq_sh2; /* debug counter - delete later */ 
uchar sq_sh3; /* debug counter - delete later */ 



/ *********************************«*-WWWWWwwwwwwwwww 
* 

* Constants and variables declared by this file. 
* 

************************************************************************/ 

static uchar coast mode; /* allows vehicle to coast in low gears */ 
static uint mocte_tTrae_out; /* time to disengage or synchronize a gear */ 



#pragma eject 



* Function: ini tial ize_sequence_shift 
* 

* Description: . 

* This function initializes the variables to be used in sequence_shif t. 
* 

************************************************************************/ 

void im" tial ize_sequence_shift< void) 

a 

shift_type = UPSHIFT; 
shift in_process = FALSE; 

> 



#pragma eject 



* Function: shift_initiate 

* ~ 

* Description: 

* This function begins the shift sequence by setting up the 

* transmission to pull to Neutral, commands the electronic engine 

* controller to go to zero torque and prepares the clutch to disengage 

* if required. 
* 

************************************************************************/ 

static void shift ini t iate(void) 
( 

if (destination gear < last_known_gear) /* determine shift type */ 

if (pet demand at cur_sp > 5) 
shift'type = POWER_DOWN_SH I FT ; 

else 

shift type - COAST DOWN SHIFT; 

> 

else 

shift_type = UPSHIFT; 



/* Attempt to get out of gear for 3 seconds then return fuel to driver 

/* 

if ( (engine_status != ENGINEERED I PJ4O0E) U <mode_time_out > 0) ) 

mode_time~out = 300; 
if ( ( modest Tme_out > 0) && <! coast jnode) ) 

--mode time out; 

*/ 

mode_time_out = 300; /* force value for now V 

/* initiate a normal shift sequence */ 

/* (do not request engine fueling with engine brake on) */ 
eng_brake_command = ENG_BRAKE_OFF; /* eng brake: zero torque */ 

if ((Ipf output speed < shf tbl .min_output_spd) || 
(clutch_state == DISENGAGED) || 
(mode_time_out ==0) || 
((destination_gear < 4) && 
(coastjnode) && 

(accelerator_pedal_posi tion <= 5) && 
(shift type != UPSHIFT))) 

( 

engine commands = ENGINE^FOLLOWER; 

> 

else 
C 

engine_coromands = ENGINEERED IP; /* engine: bring torque to zero * 

coast mode = FALSE; 

> 

> 

#pragma eject 



* Function: synch r on ize_gear 
* 

* Description: . . 

* This function assists the sychronizing of the transmission if 

* possible, by controlling input shaft speed through the use 

* of the clutch, power synchronizer, or inertia brake. It will 

* offset sync windows if the shift is taking longer than expected. 

* It will assist with engagement at rest if the clutch is dragging. 
* 

*********************************************************** 

static void synch ronize_gear< void) 

/* turn on engine brakes (J1939) if engine brake assisted shift is requested 

if (eng brake assist) 

engJ)rake_coninand = ENG_BRAKE_FULL; 

else 

eng_brake_comnand = ENG_BRAKE_OFF; 
/* Attest to engage for 6 seconds then return fuel control to the driver */ 

/* 

if ( <engine_status != ENGINE_SYNCJ100E) && ( modest imejxJt > 0) ) 

mode time out = 600; 
if ( (mode_time_out > 0) && < Icoastjnode) ) 

--mode time-out; 

*/ 

mode_time_out = 600; /* force value for now */ 

if ((Ipf output speed < shf tbl .min_output_spd) || 
(clutch_state == DISENGAGED) || 
(mode_tTme_out ==0) | | 
(<destinatTon_gear < 4) && 
(coast_mode) && 

<accelerator_pedal jwsition <= 5) && 
(shift type != UPSHIFT))) 

< 

engine_comnands = ENGINE_FOLLOUER; 

> 

else 

<: 

engine.commands = ENGINE_SYNC; 
coast mode = FALSE; 

> 



#pragma eject 



* Function: conf ira_shift 

* ~ 

* Description: 

* This function finished the shift; shif t_in_process is set FALSE. 
* 

static void conf irm^shi ft (void) 

engine conmands = ENGINE RECOVERY; /* engine: finish torque return 

eng brake conmand = ENG BRAKE OFF; /* eng brake: zero torojje V 

mode_time"out = 300; ~ /* reset for next shift V 

shi ft_in_process s FALSE; 
coastjnode = TRUE; 



#pragma eject 



* Function: sequence_shif t 



* Description: 

* This function calls the appropriate procedures to perform the 

* operations of Sequence_Shift depending on the correct state of 

* the shift process. 
# 

void sequence_shift(void) 

{ if (destination gear == NULLJ5EAR) /* system has reset: do not start a shift 

engine commands = ENGINE_FOLLOUER; 
eng brake command = ENG_BRAKE_IDLE; 

> 



if ((transmission _position == OUT_OF_GEAR ) && 
((engine status == ENG I NE_SYNC_MCOE ) || 

(engine~status == ENGINE_PREDIP_MOOE))) /* forces call shiftJnitiateO 

C 

sq_sh1++; 

synchronize gearO; 

> 



if (((engine status == ENG I NE_SYNC_MODE ) || 

(enginejitatus == ENG I NE_RECOVERY_MO0E ) ) && 

(destination_gear == current_gear) && 
(transmission_position == IN_GEAR)) 

t 

sq_sh2++; 
confirm shiftO; 

> 



if (((destination gear != current_gear) && /* auto splitter */ 
(low_speed_latch == FALSE) && 
( automat ic_sip ! s 0) && 
(transmissTonjX)sition == I N_GEAR ) ) || 

((transmission_position == OUTJ)F_GEAR) && /* manual shift */ 
(iow_speed latch == FALSE))) 

i 

shift_initiate<); 
sq_sh3++; 

> 



Unpublished and confidential. Mot to be reproduced, 
disseminated, transferred or used without the prior 
written consent of Eaton Corporation. 

Copyright Eaton Corporation, 1994. 
All rights reserved. 



* Filename: tiw.acr.c96 (AutoSplit) 
* 

* Description: 

* This modules monitors and controls the transmission actions. 
• 

* Part Number: <none> 
* 

* $Log: ??? $ 
* 

* Rev 1.0 3 May 1994 13:35:04 markyvech 

* Initial revision. 



/•*** 
* 

* Header files included. 



#include <exec.h> 
#include <c_regs.h> 
^include <kr_sfr.h> 
* include <kr_def.h> 
#include <wwslib.h> 
#include "drl_cmds.h" 
#include "trns act.h" 
#include »trn_tbl.h» 
#include "calc_spd.h" 
#include "cont sys.h" 
#include "sel gear.h" 
#include »con7l939.h» 



/* executive information */ 

/* KR internal register definitions 
/* defines the kr special function registers */ 
/* 80c196kr bits, constants, and structures V 

/* engine control interface */ 
/* interface to this module */ 
/* transmission table */ 



* Variables declared by this file. 
* 

***************************************************************************/ 

register unsigned char transmissionjxsi tion; 



uns i gned 
uns i gned 
uns i gned 
uns i gned 
unsigned 
uns i gned 
unsigned 
signed 
signed 
signed 
unsigned 
unsigned 
unsigned 
unsigned 
signed 
signed 
signed 
signed 
signed 



char 

char 

char 

char 

char 

char 

char 

char 

char 

char 

int 

int 

int 

int 

int 

int 

int 

int 

int 



signed long 
signed long 
signed char 



low_speed_latch; 

forward_Last; 

splitter_hi; 

splitter_lo; 

splitter'timer; 

spl i tter'wi thin_sync; 

aux_box;~ 

g_ptr_old; 

current_gear; 

lastjcn©wn_gear; 

gear~in_timer; 

gear_out_timer; 

abs_t r ans_sync_er r or ; 

t r ans_w i ndow _ca I c ; 

i r»put"speed_mod i f i ed; 

t r ans_sync_er ror ; 

range~error; 

range~cal ; 

splitter_tc; 

isdgf ; 

gros; 

g_ptr; 



#pragma eject 



* 

* #defines and- constants local to this file. 



#define US PER LOOP 10000U 
^define RKH_USJ>ER_LOOP 40000U 



static const 
t 
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>; 



static const 
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overdrive */ 
direct */ 
direct */ 
direct */ 
overdrive */ 
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overdrive */ 
direct */ 
overdrive V 
direct */ 
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splitjn 
splitjn 
splitjn 
splitjn 
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overdrive */ 
direct V 
direct V 
di rect */ 
overdrive V 
direct */ 
overdrive */ 
direct */ 
overdrive */ 
direct */ 
overdrive */ 
direct */ 
overdrive */ 



>; 



#pragma eject 



static const uchar SPt I TTER_TC_TABIE C233 ■ 

< /* Splitter aoveaent ti«e constant in Billiseconds */ 





/* 


-4 


*/ 












o, 


/* 


-3 


V 












100, 


/* 


-2 


V 


/• 


splitter 


3 


overdrive 


V 


100, 


/* 


-1 


V 


/* 


splitter 


= 


direct 


V 


100, 


/* 


0 


V 


/* 


splitter 


S 


direct 


*/ 


100, 


/* 


1 


*/ 


/* 


splitter 


s 


direct 


•/ 


100, 


/* 


2 


V 


/* 


splitter 


a 


overdrive 


V 


100, 


/* 


3 


V 


/* 


spl i tter 


3 


direct 


V 


100, 


/* 


4 


V 


/* 


spl itter 


3 


overdrive 


*/ 


100, 


/* 


5 


*/ 


/* 


spl itter 


= 


direct 


V 


100, 


/* 


6 


V 


/* 


spl itter 


3 


overdrive 


*/ 


100, 


/* 


7 


V 


/* 


splitter 


3 


direct 


*/ 


100, 
100, 


/* 


8 


V 


/* 


splitter 


3 


overdrive 


*/ 


/* 


9 


V 


/* 


splitter 


3 


direct 


*/ 


100, 


/* 


10 


*/ 


/* 


splitter 


3 


overdrive 


*/ 


o, 


/* 


11 


*/ 












o, 


/* 


12 


*/ 












o, 


/* 


13 


*/ 












o, 


/* 


14 


V 












o, 


/* 


15 


V 












o, 


/* 


16 


*/ 












o, 


/* 


17 


*/ 












0 


/* 


18 


*/ 













>; 



#pragma eject 



* Function: Initialize_Trans_Action 
• 

* Description: 

* This function initializes those module variables that must be set to a 

* know state on power up or reset. 
* 

***************************************************************************/ 

void initial ize_trans_action(void) 



gear_in_timer = 200; 
gear_out_timer = 200; 
g_ptr_old = 0; 
current_gear = 0; 
last_known_gear « 0; 
destTnation_gear = 0; 
transmission_position = 0UT_0F_GEAR; 
low_speed_latch = TRUE; 
splltterjfo = 0; 
splitter_hi = 0; 



#pragma eject 



* Function: determine_gear 

* ~~ 

* Description: 

* This function determines the current gear that the transmission 

* is in. When conditions are such that the current gear can not be 

* determined it will be set to a default ( (0). 

* Note: When the error across the transmission is near zero for some 

* time for a given test gear then it will be deemed in that gear. 
* 

* error = input_spd/gf tgear] - grtgear) * os 



void determine_gear<void) 
i 

#define BIN 8 
#define MAX ERR 
#def ine WINDOW 
#define GEAR IN TIME LEVER 
#define GEAR J N TIME_AUTO 
#define GEAR OUT TIME 
#def ine ERROR FUDGE FACTOR 
/* 

signed long isdgf; 
signed long gros; 
signed char g_ptr; 
V 
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/* 
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*/ 


4000 


/* 


RPM 


*/ 


30 


/* 


30 RPM 


V 
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/* 


300 MSEC 


*/ 


20 


/* 


200 MSEC 


*/ 


8 


/* 


80 MSEC 


*/ 


t 3 


/* 


RPM 


V 



#if (0) 

g_ptr = -1; /* lowest reverse ratio */ 

/* isdgf = (((signed long) input_speedji Itered) * BIN_8) / trn_tbl .GF[gj>tr ♦ GRJJFSl ; */ 
bx = (signed int)( input_speed_fi Itered) ; 
~cx = BIN 8; 

_ax = trn_tbl.GF[g_ptr + GRJ5FS] ; 
asm mul _cxdx, _bx; 
asm div _cxdx, _ax; 
isdgf = _cx; 

/* gros = (((signed long) output_speed_f i Itered) * trn_tbl.GR[g_ptr ♦ GRJ3FSJ > / BINJ2; */ 
bx = (signed int)(output_speed_f iltered ♦ ERROR_FUDGE_FACTOR); 
~cx = trn_tbl.GR[g_ptr ♦ GR_0FS]"; 
"ax = BIN_8; 
asm mul _cxdx, _bx; 
asm div _cxdx # _ax; 
gros = _cx; 

trans_sync_error = (isdgf -gros); 
if (isdgf > gros) 

abs_trans_sync_error « (unsigned int)( isdgf - gros); 
else 

abs trans sync error = (unsigned int)(gros - isdgf); 

#endif 

abs_trans_sync_error = MAX_ERR; 
trans_window_calc =0; 

if (abs trans sync_error > trans_window_calc) /* if not in reverse, check for forward */ 

{ 

g_ptr = 1 ♦ t rn_tbl. hi ghes ^forward; 
abs trans sync error = MAX_ERR; 

while ((abs trans sync_error > trans_window_calc) && (g_ptr != 0)) 
C 

g_ptr~~ ; 

/* isdgf = (((signed long) input_speed.fi Itered) * BIN_8) / trn_tbl.GF[gj>tr ♦ GR0FS1; V 
bx = (signed int)(input_speed_fi Itered) ; 
~cx = BIN 8; 

_ax = trn_tbl.GF[g_ptr ♦ GR.OFS]; 
asm mul _cxdx, _bx; 
asm div _cxdx, _ax; 
isdgf = _cx; 

/* gros » (((signed long) output speed filtered) * trn_tbl.GRtg_ptr ♦ GR.0FS3) / BIMJ2; */ 
bx = (signed int)<«itput_speed_f iltered ♦ ERR0R_FU0GE_FACT0R ) ; 
"ex « trn_tbl.GRIg.ptr ♦ GRJDFsT; 



_ax * BIN_8; 
asai wui _cxdx, _bx; 
asm div "cxdx, _ax; 
gros » _cx; 



trans_sync_error » isdgf - gros; 
if (isdgf > gros) 
abs_trans_sync_error s (intXisdgf • gros); 

else 

abs_trans_sync_error = (intXgros - isdgf); 

/* calculate trans sync error window based on gear pointer */ 
- /* qiu n */ 



bx = WINDOW; 
"ex = BIN 8; 
"ax = trn~tbl.GF[g_ptr + GR_OFS]; 
asm mulu _cxdx, _bx; 
asm divu _cxdx, _ax; 
trans_window_calc = _cx; 



/* BIN 0 */ 
/* BIN 8 */ 
/* BIN 8 */ 

/* make WINDOW BIN 8 */ 

/* divide by front ration BIN 8 */ 

/* BIN 0 */ 



/* If in neutral, force values */ 



if <gj>tr == 0) 
i 

abs_trans_sync_error = MAX_ERR; 
trans_sync_error = MAX_ERR; 
trans~window_calc = 0; 
isdgf ~= 0; 
gros = 0; 

> 

f ((abs trans sync error > trans window_calc) || /* Must have error for some V 
<<g ptr » = current gear) && (current gear != 0))) /* before neutral state is */ 
" /* recognized. */ 

if (gear out timer == 0) 
i 



transmission_position = 0UT_0F_GEAR; 
current_gear = 0; 



else 

gea r_out_t imei — ; 

> 

else 

gear_out_timer = GEAR_OUT_TIME; 



if (<g_ptr != g_ptr_old) || (g_ptr == 0) || 
((accelerator_pedal_posi tion < 5) && 
(input speed < 800) && 
(low speed latch == FALSE))) 

< 

if ((engine commands == ENGINE_SYNC) || 
(engine"conmands -= ENGINEERED IP)) 

< 

if (shift init_type == AUTO) 

gear_inltimer = GE AR_ I N_T I ME_AUTO ; 
else 

gearjn_timer = GEARJN_TIME_LEVER; 



/* 
/* 
/* 
/* 
/* 



if not in gear, init gear in timer. 
Rule out picking a gear when coasting 
down in neutral and no throttle. 
(Found that idle speed and output speed 
would natch a gear even when in neutral. 



> 



else 

if (gear_in_timer s 3 0) 
i 

current_gear = g_ptr; 
last_known_gear = g_ptr; 
transmission_position = IN_GEAR; 

if ((gos current gear > (downshi f tjpoint ♦ 100)) && 
(low~speed_latch == TRUE)) 

C 

low_speed_tatch = FALSE; 
destination_gear = current_gear; 
destination~gear_selected = current_gear; 
desired_gear = current_gear; 
lowest forward * current_gear; 

> 

else 
i 



if (low speedjatch == TRUE) 
i 

destinationjjear » lowest_forward; 
dest i nat i orTgear_se lected s lowest_forward; 
desired_gear » I owes t_f or ward; 
shift in ^process » FALSE; 

> 

> 

if (last known gear > 0) 

forwarcUast = TRUE; 
else 

forward last = FALSE; 

> 

else 

gear_in_timer--; 

g_ptr_old = gj>tr ; 
if (output speedjiltered < 80) /* If stopped - current_gear = first, 
current gear = 0 ; 

transmission_position = 0UTJ)FJiEAR; 
low speed latch = TRUE; 

> 

> 

#pragma eject 



/* was set to 1 * 
/* was set to 1 * 
/* was set to 1 * 



/* Record REV/FOR data for 
/* use in the select_gear 
/* module. 



* Function: determine_range_status 
* 

* Description: 

* This function determines the status the of range. 
* 

* rng_err = rear_counter_spd * (range_ratio * otitput_spd) 

* ~" 

* res = 54/21 * 44 * os (for low range) 
* 

* res = 42/51 * 44 * os (for high range) 



void determine range status(void) 
< 

#define BIN 12 4096 /* 2 bin 12 */ 

#define HI RANGE GEAR 7 

#define 10"rANGE~CAL 10532 /* 54/21 BIN 12 */ 

#define HI"rANGE~CAL 3373 /* 42/51 BIN 12 */ 

#define RANGE WINDOW POS 30 /* 30 RPM V 

#define RANGEJHNDOWJIEG -30 /* -30 RPM */ 

if (destination gear >= HI_RANGE_GEAR> 

range_cal = hT_RANGE_CAL; 
else 

range_cal = LO_RANGE_CAL; 

range error =(((aux speed * BIN_12) 

- (range_cal * output_speed_f i Itered) )/BINJ2); 

if ((range error > RANGE_UINDOWJ>OS) || (range_error < RANGE_UINDOW_NEG) 

aux_box = 0UT_0F_GEAR;~ 
else 

aux_box = IN_GEAR; 

> 



ffpragma eject 



* Function: determine_splitter 
* 

* Description: 

* This function determines the correct state for the splitter. 

* Once the transmission is in gear both splitter solenoids are turned off. 
* 

♦•♦♦♦♦a*****************************************************************/ 



void determine_splitter_state(void) 

#define SPUR SYNC OFFSET POS 80 /* 80 RPM V 

#define SPLTR~SYN(f OFFSET NEG -80 /* -80 RPM V 

#define SPLITTER tTmE 20 /* 200 MSEC */ 



if (engine status == ENGINEERED I P.MOOE) 

sptitter~timer = SPLITTER_TIME; 
else 

if (splitter_timer > 0) 
splitter_tlmer--; 



splitter_tc = SPL I TTER_TC_TABLE [dest i nat i on_gear ♦ GR_OFS3; 

input speed modified = (signed int)(input_speed_f i Itered) + 

( input_speed_accel_f i ltered/(1000/spl i tter_tc)); 

if ((input speed modified < (gos signed + SPLTR_SYNC_OFFSETJ>OS)) && 
(input"speed"modified > (gos_signed ♦ SPLTR_SYNC_OFFSET_NEG))) 
splitter~within_sync = TRUE ; 
else 

splitter_within_sync = FALSE; 



if ((splitter_timer > 0) | | 

((transmissionj»sition == IN GEAR) && /* debug - delete later * 

(shiftJn_process == FALSE)) || /* debug - delete later * 

(low_speed_latch == TRUE) || 

(engine_status == ENG I NE_RECOVER Y_MO0E ) || 

((shift init type == MANUAL) && 
(engine_status == ENGI NE_SYNC_MOOE ) ) || 

((shift init type == AUTO) && 
( engines tatus == ENGINE_SYNC_MOOE) && 
(splitter_within_sync == TRUE))) 

C splitter hi = SPLITTER HI TABLE Cdesti nat ion_gear ♦ GR_OFS3; 
splitter~Lo * SPLITTER~LO~TABLE[destination_gear ♦ GRJ5FS]; 

> 

else 
i 

splitter_hi = OFF; 
splitter~lo = OFF; 

> 



#pragma eject 



* Function: Transmission_Action 
* 

* Description: 

* This funtion controls the states of the system ouput devices. 



void transmission act ion< void) 
initialize trans actionO; 



/* initialize variables */ 



x start_periodic(); 

while (1) 

C 

determine_gear(); 

de t e rm i ne^r ange_s t a t us ( ) ; 

determine~splitter_state<); 

x syncjjeriodicCUS^PER.LOOP); 

x_end_periodicO; 



/* calculate the current gear */ 

/* determine range state V 

/* determine correct state for splitter V 
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